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1.  Scope. 

This  section  shall  be  divided  into  the  following  paragraphs. 

1,1.  Identification. 

This  Software  Maintenance  Manual  (SMM)  applies  to  document  number 
WDL/TR92-003011  entitled  System  Specification  for  the  Rotary  Wing  Aircraft 
AirNet  Aeromodel  and  Weapons  Model  Conversion.  This  SMM  also  applies 
to  the  AirNet  CSCI. 


1.2.  System  overview. 

The  Rotary  Wing  Aircraft  (RWA)  system  and  SIMNET  Computer  System 
Configuration  Item  (CSCI)  simulates  a  manned  flight  vehicle  and  associated 
weapons  systems  for  conducting  simulated  missions  within  a  controlled 
database  and  tactical  environment. 

I 

1.3.  Document  overview. 

The  following  paragraphs  and  subparagraphs  identify  the  data  variables, 
Computer  Software  Units  (CSU)  and  algorithms  that  use  the  data  read  from 
data  files  during  initialization.  These  data  files  were  constructed  as  a  task  of 
the  Rotary  Wing  Aircraft  AirNET  Aeromodel  and  Weapons  Model 
Conversion  Delivery  Order  and  are  documented  in  detail  in  Software  Design 
Document  for  the  AirNET  Aeromodel  and  Weapons  Model  Conversion. 
Certain  CSUs  were  modified  to  allow  the  reading  of  data  values  from  data 
files.  Computer  Software  Components  (CSC)  and  CSUs  existing  in  original 
code  are  only  documented  herein  to  the  extent  that  the  data  from  these  data 
files  is  used.  The  original  function  and  operation  of  the  software  was  not 
modified.  This  additional  capability  allows  for  the  change  of  variables 
without  requiring  a  recompile.  This  SMM  is  compiled  as  a  guide  to  the 
software  programmer  to  assist  in  understanding  how  the  data  variables  are 
used  and  how  a  modification  of  the  data  will  effect  computation  of  certain 
performance  characteristics  and  limits  of  the  aeromodel,  engines,  and  weapon 
systems.  The  modifications  to  the  MCC  and  communications  software  are 
covered  in  a  separate  volume. 
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2.  Referenced  documents. 

The  following  documents  are  referenced  within  this  document. 

WDL/TR-92-003011  SYSTEM  SPECIFICATION  FOR  THE 

ROTARY  WING  AIRCRAFT  AIRNET 
AEROMODEL  AND  WEAPONS 
MODEL  CONVERSION,  6  JUNE  1992. 


WDL/TR-93-003036  SOFTWARE  DESIGN  DOCUMENT 

FOR  THE  ROTARY  WING  AIRCRAFT 
AIRNET  AEROMODEL  AND 
WEAPONS  MODEL  CONVERSION, 
22  JANUARY  1993. 


I 
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3.  Modifiable  data. 

The  following  subparagraphs  address  the  data  contained  in  the  data 
files  which  are  read  during  initialization.  Changes  to  the  data  files 
do  not  normally  require  a  recompilation  of  the  source  code  and  re¬ 
link  of  the  libraries.  The  configuration  management  group  should  be 
contacted  if  it  is  necessary  to  make  source  code  changes  to  the 
baseline. 
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3.1  Aero_data 

This  data  array  consists  of  characteristics  and  parameters  describing  the 
physical  vehicle  and  its  aerodynamic  performance  and  control. 

3.1.1  MOMENT_OF_INERTIA_X 

MOMENT_OF_INERTIA_X  is  a  constant  defining  the  moment  of  inertia  of 
the  vehicle  in  the  x-axis. 

3.1.1.1  Initialization 

The  constant  MOMENT_OF_INERTIA_X  is  initialized  during  execution  of 
the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MOMENT_OF_INERTIA_X  aero_data[  0] 

3,1.1.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.1.2.1  Algorithm 

The  MOMENT_OF_INERTIA_X  is  used  to  initialize  the  [1][1]  element  of  the 
inertia  matrix  in  the  CSU  aerodynjnit. 


inertia_matrix[l]  [1]  =  MOMENT_OF_INERTIA_X; 


The  MOMENT_OF_INERTIA_X  is  used  to  compute  forces  in  the  CSC 
aerodyn_simple_simul. 
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I*  First,  compute  the  angular  velocity  necessary  to  achieve  the  */ 

I*  desired  orientation  in  exactly  one  tick,  (delta  theta/  delta  T)  * ! 

I*  Then  get  the  angular  acceleration  needed  to  get  to  that  velocity  */ 
In  one  tick.*/ 
for  (i  =  X;  i  <=  Z;  ++i) 

{ 

vec_ptr[i]  =  ((des_ptr[i]  -  cur_ptr[i])  /  DELTA_T  /  H_K1); 
angular_accel[i]  =  (vec_ptr[i]  -  angular_velocity_vector[i]) 

/  DELTA_T; 

res_ptr[i]  =  MOMENT_OF_INERTIA_X  *  angular_accel[i]; 

} 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.2  MOMENT_OF_INERTIA_Y 

MOMENT_OF_INERTIA_Y  is  a  constant  defining  the  moment  of  inertia  of 
thh  vehicle  in  the  y-axis. 

3.1.2.1  Initialization 

The  constant  MOMENT_OF_INERTIA_Y  is  initialized  during  execution  of 
the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MOMENT_OF_INERTIA_Y  aero_data[  1] 


3.1.2.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.2.2.1  Algorithm 

The  MOMENT_OF_INERTIA_Y  is  used  to  initialize  the  [2]  [2]  element  of  the 
inertia  matrix  in  the  CSU  aerodynjnit. 


inertia_matrix[2]  [2]  =  MOMENT_OF_INERTIA_Y; 
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See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.3  MOMENT_OF_INERTIA_Z 

MOMENT_OF_INERTIA_Z  is  a  constant  defining  the  moment  of  inertia  of 
the  vehicle  in  the  z-axis. 

3.1.3.1  Initialization 

The  constant  MOMENT_OF_INERTIA_Z  is  initialized  during  execution  of 
the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MOMENT_OF_INERTIA_Z  aero_data[  2] 


3.1.3.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.3.2.1  Algorithm 

The  MOMENT_OF_INERTIA_Z  is  used  to  initialize  the  [3]  [3]  element  of  the 
inertia  matrix  in  the  CSU  aerodyn_init. 

inertia_matrix[3]  [3]  =  MOMENT_OF_INERTIA_Z; 


See  APPENDIX  B  for  a  complete  source  code  listing. 


3.1.4  AIRFRAME_MASS 

AIRFRAME_MASS  is  a  constant  defining  the  empty  weight  of  the  vehicle, 
especially,  not  including  expendable  items. 

3.1.4.1  Initialization 

The  constant  AIRFRAME_MASS  is  initialized  during  execution  of  the  CSU 
aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodynjnit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a  summary  of 
the  constant. 
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#define  AIRFRAME_MASS 


aero_data[  3] 


3.1.4.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.4.2.1  Algorithm 

The  AIRFRAME_MASS  is  used  to  initialize  the  vehicle  mass  in  the  CSU 
aerodyn_init. 

vehicle_mass_init  (AIRFRAME_MASS  +  ORDINANCE_MASS, 

inertia_matrix  ); 

The  AIRFRAME_MASS  is  used  to  update  the  vehicle  gross  weight  by  a  call  to 
the  CSU  compute_gross_weight. 

vehicle_mass  =  AIRFRAME_MASS  +  ORDINANCE_MASS  + 

fuel_get_current_level()  *  KILOGRAMS_PER_GALLON;/*  kg  *! 

gross_weight  =  vehicle_mass  *  GRAV_CONSTANT;  I*  N  *! 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.5  ORDlNANCE_MASS 

ORDINANCE_MASS  is  a  constant  defining  the  weight  of  the  ordinance  on 
board  the  vehicle,  especially,  the  expendables. 

3.1.5.1  Initialization 

The  constant  ORDINANCE_MASS  is  initialized  during  execution  of  the  CSU 
aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a  summary  of 
the  constant. 
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#define  ORDINANCE_MASS  aero_data[  4] 

3.1.5.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.5.2.1  Algorithm 

The  ORDINANCE_MASS  is  used  to  initialize  the  vehicle  mass  in  the  CSU 
aerodyn_init. 

vehicle_mass_init  (AIRFRAME_MASS  +  ORDINANCE_MASS, 

inertia_matrix  ); 

The  ORDINANCE_MASS  is  used  to  update  the  vehicle  gross  weight  by  a  call 
tcy  the  CSU  compute_gross_weight. 

vehicle.mass  =  AIRFRAME_MASS  +  ORDINANCE_MASS  + 

fuel_get_current_level()  *  KILOGRAMS_PER_GALLON;/*  kg  */ 

gross_weight  =  vehicle_mass  GRAV_CONSTANT;  I*  N  */ 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.6  GRAV_CONSTANT 

GRAV_CONSTANT  is  a  constant  defining  the  gravitational  constant. 

3.1.6.1  Initialization 

The  constant  GRAV_CONSTANT  is  initialized  during  execution  of  the  CSU 
aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a  summary  of 
the  constant. 


#define  GRAY  CONSTANT 

aero  data[  5] 
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3.1.6.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.6.2.1  Algorithm 

The  GRAV_CONSTANT  is  used  to  update  the  vehicle  gross  weight  by  a  call 
to  the  CSU  compute_gross_weight. 


gross_weight  =  vehicle_mass  *  GRAV_CONSTANT;  /*  N  */ 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.7  CG_AC_X 

CG_AC_X  is  a  constant  defining  the  location  of  the  aircraft  center  of  gravity 
in,  the  x-axis. 

3.1.7.1  Initialization 

The  constant  CG_AC_X  is  initialized  during  execution  of  the  CSU 
aerodyn_init,  called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodynjnit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a  summary  of 
the  constant. 


#define  CG_AC_X  aero_data[  6] 

3.1.7.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.7.2.1  Algorithm 

The  CG_AC_X  is  used  to  initialize  the  vehicle  location  of  the  aircraft  center 
of  gravity  in  the  x-axis  in  the  CSU  aerodynjnit. 

loc_ac_cg[X]  =  CG_AC_X; 


See  APPENDIX  B  for  a  complete  source  code  listing. 
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3.1.8  CG_AC_Y 

CG_AC_Y  is  a  constant  defining  the  location  of  the  aircraft  center  of  gravity 
in  the  y-axis. 

3.1.8.1  Initialization 

The  constant  CG_AC_Y  is  initialized  during  execution  of  the  CSU 
aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a  summary  of 
the  constant. 


#define  CG  AC  Y 

aero  data[  7] 

3.1.8.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.8.2.1  Algorithm 

The  CG_AC_Y  is  used  to  initialize  the  vehicle  location  of  the  aircraft  center 
of  gravity  in  the  y-axis  in  the  CSU  aerodynjnit. 

loc_ac_cg[Y]  =  CG_AC_Y; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.9  CG_AC_Z 

CG_AC_Z  is  a  constant  defining  the  location  of  the  aircraft  center  of  gravity 
in  the  z-axis. 

3.1.9.1  Initialization 

The  constant  CG_AC_Z  is  initialized  during  execution  of  the  CSU 
aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodynjnit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a  summary  of 
the  constant. 
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#define  CG_AC_Z  aero_data[  8] 

3.1.9.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.9.2.1  Algorithm 

The  CG_AC_Z  is  used  to  initialize  the  vehicle  location  of  the  aircraft  center 
of  gravity  in  the  z-axis  in  the  CSU  aerodynjnit. 

loc_ac_cg[Z]  =  CG_AC_Z; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.10  VIRTUAL_WING_AREA 

VIRTUAL_WING_AREA  is  a  constant  defining  the  effective  wing  area  of  the 
vehicle. 

3.1.10.1  Initialization 

The  constant  VIRTUAL_WING_AREA  is  initialized  during  execution  of  the 
CSU  aerodynjnit,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  VIRTU AL_WING_ AREA  aero_data[  9] 


3.1.10.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.10.2.1  Algorithm 

The  VIRTUAL_WING_AREA  is  used  to  compute  the  total  lift  of  the  virtual 
wing  of  the  vehicle  by  a  call  to  the  CSU  computeJift_dragJorces. 
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lift_virtual_wing  =  dynamic_pressure  * 

lift_coefficient_virtual_wing  *  VIRTUAL_WING_AREA; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.11  VIRTUAL_WING_COP_AC_X 

VIRTUAL_WING_COP_AC_X  is  a  constant  defining  the  location  in  the  x- 
axis  of  the  virtual  wing  center  of  pressure. 

3.1.11.1  Initialization 

The  constant  VIRTUAL_WING_COP_AC_X  is  initialized  during  execution 
of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 

f  _ • 

#define  VIRTU AL_WING_COP_AC_X  aero_data[10] 


3.1.11.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.11.2.1  Algorithm 

The  VIRTUAL_WING_COP_AC_X  is  initialize  the  location  in  the  x-axis  of 
the  center  of  pressure  for  the  virtual  wing  in  the  CSU  aerodyn_init. 


loc_ac_virtual_wing_cop[X]  =  VIRTUAL_WING_COP_AC_X; 


The  location  of  the  center  of  pressure  for  the  virtual  wing  is  used  to  compute 
lift  and  moments  due  to  lift. 


vec_cross_prod(loc_ac_virtual_wing_cop,lift_body_virtual_wing, 

moment_body_virtual_wing); 


See  APPENDIX  B  for  a  complete  source  code  listing. 
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3.1.12  VIRTUAL_WING_COP_AC_Y 

VIRTU AL_WING_COP_AC_Y  is  a  constant  defining  the  location  in  the  y- 
axis  of  the  virtual  wing  center  of  pressure. 

3.1.12.1  Initialization 

The  constant  VIRTUAL_WING_COP_AC_Y  is  initialized  during  execution 
of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  VIRTUAL_WING_COP_AC_Y  aero_data[ll] 


3.1.12.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.12.2.1  Algorithm 

The  VIRTUAL_WING_COP_AC_Y  is  initialize  the  location  in  the  y-axis  of 
the  center  of  pressure  for  the  virtual  wing  in  the  CSU  aerodynjnit. 


loc_ac_virtual_wing_cop[Y]  =  VIRTU  AL_WING_COP_AC_Y; 


The  location  of  the  center  of  pressure  for  the  virtual  wing  is  used  to  compute 
lift  and  moments  due  to  lift. 


vec_cross_prod(loc_ac_virtual_wing_cop,lift_body_virtual_wing, 

moment_body_virtual_wing); 

See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.13  VIRTUAL_WING_COP_AC_Z 

VIRTUAL_WING_COP_AC_Z  is  a  constant  defining  the  location  in  the  z- 
axis  of  the  virtual  wing  center  of  pressure. 
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3.1.13.1  Initialization 

The  constant  VIRTU AL_WING_COP_AC_Z  is  initialized  during  execution 
of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  VIRTU AL_WING_COP_AC_Z  aero_data[12] 


3.1.13.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.13.2.1  Algorithm 

The  VIRTU AL_WING_COP_AC_Z  is  initialize  the  location  in  the  z-axis  of 
the  center  of  pressure  for  the  virtual  wing  in  the  CSU  aerodynjnit. 

loc_ac_virtual_wing_cop[Z]  =  VIRTU  AL_WING_COP_AC_Z; 


The  location  of  the  center  of  pressure  for  the  virtual  wing  is  used  to  compute 
lift  and  moments  due  to  lift. 


vec_cross_prod(loc_ac_virtual_wing_cop,lift_body_virtual_wing, 

moment_body_virtual_wing); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.14  WING_LIFT_COEFFICIENT_FIT_3 

WING_LIFT_COEFFICIENT_FIT_3  is  a  constant  defining  the  fourth 
coefficient  of  the  wing  lift  coefficient  polynomial  used  to  compute  the  wing 
lift  coefficient. 

3.1.14.1  Initialization 

The  constant  WING_LIFT_COEFFICIENT_FIT_3  is  initialized  during 
execution  of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the 
CSU  aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and 
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is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  WING_LIFT_COEFFICIENT_FIT_3  aero_data[13] 


3.1.14.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.14.2.1  Algorithm 

The  WING_LIFT_COEFFICIENT_FIT_3  is  used  to  compute  the  unit  lift  of 
the  virtual  wing  by  a  call  to  the  CSU  virtual_wing_lift_coefficient.  The  call 
to  this  CSU  is  commented  out. 


if  (alpha  >  WE^JG_STALL_AOA  1  1  alpha  <  0.0) 
return  (0.0); 

else 

return  (((WING_LIFT_COEFFICIENT_FIT_3  alpha  + 
WING_LIFT_COEFnCIENT_nT_2)  alpha  + 
WING_LIFT_COEFnCIENT_nT_l)  *  alpha  + 
WING_LIFT_COEFFICIENT_nT_0); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.15  WING_LIFT_COEFFICIENT_FIT_2 

WING_LIFT_COEFFICIENT_FIT_2  is  a  constant  defining  the  third 
coefficient  of  the  wing  lift  coefficient  polynomial  used  to  compute  the  wing 
lift  coefficient. 

3.1.15.1  Initialization 

The  constant  WING_LIFT_COEFFICIENT_FIT_2  is  initialized  during 
execution  of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the 
CSU  aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 
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#define  WING_LIFT_COEFFICIENT_FIT_2  aero_data[14] 

3.1.15.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.15.2.1  Algorithm 

The  WING_LIFT_COEFFICIENT_FIT_2  is  used  to  compute  the  unit  lift  of 
the  virtual  wing  by  a  call  to  the  CSU  virtual_wing_lift_coefficient.  The  call 
to  this  CSU  is  commented  out. 


if  (alpha  >  WING_STALL_AOA  I  I  alpha  <  0.0) 
return  (0.0); 

else 

return  (((WING_LIFT_COEFFICIENT_nT_3  alpha  + 
WING_LIFT_COEFnCIENT_FIT_2)  alpha  + 
WING_LIFr_COEFFICIENT_nT_l)  *  alpha  + 
WING_LIFT_COEFFICIENT_nT_0); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.16  WING_LIFT_COEFFICIENT_FIT_l 

WING_LIFT_COEFFICIENT_FIT_l  is  a  constant  defining  the  second 
coefficient  of  the  wing  lift  coefficient  polynomial  used  to  compute  the  wing 
lift  coefficient. 

3.1.16.1  Initialization 

The  constant  WING_LIFT_COEFFICIENT_FIT_l  is  initialized  during 
execution  of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the 
CSU  aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  WING_LIFT_COEFFICIENT_FIT_l  aero_data[15] 


3.1.16.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 
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3.1.16.2.1  Algorithm 

The  WING_LIFT_COEFFICIENT_FIT_l  is  used  to  compute  the  unit  lift  of 
the  virtual  wing  by  a  call  to  the  CSU  virtual_wing_lift_coefficient.  The  call 
to  this  CSU  is  commented  out. 


if  (alpha  >  WING_STALL_AOA  1  1  alpha  <  0.0) 
return  (0.0); 

else 

return  (((WING_LIFT_COEFFICIENT_FIT_3  *  alpha  + 
WING_LIFT_COEFnCIENT_nT_2)  alpha  + 
WING_LIFT_COEFnCIENT_nT_l)  *  alpha  + 
WING_LIFT_COEFFICIENT_nT_0); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.17  WING_LIFT_COEFFICIENT_FIT_0 

WING_LIFT_COEFFICIENT_Fn'_0  is  a  constant  defining  the  first  coefficient 
of  the  wing  lift  coefficient  polynomial  used  to  compute  the  wing  lift 
coefficient. 

3.1.17.1  Initialization 

The  constant  WING_LIFT_COEFFICIENT_FIT_0  is  initialized  during 
execution  of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the 
CSU  aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  WING_LIFT_COEFFICIENT_FIT_0  aero_data[16] 


3.1.17.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.17.2.1  Algorithm 

The  WING_LIFT_COEFFICIENT_FIT_0  is  used  to  compute  the  unit  lift  of 
the  virtual  wing  by  a  call  to  the  CSU  virtual_wing_lift_coefficient.  The  call 
to  this  CSU  is  commented  out. 


-17- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


if  (alpha  >  WING_STALL_AOA  I  I  alpha  <  0.0) 
return  (0.0); 

else 

return  (((WING_LIFT_COEFFICIENT_nT_3  alpha  + 
WING_LIFT_COEFnCIENT_FIT_2)  alpha  + 
WING_LIFT_COEFnCIENT_nT_l)  alpha  + 
WING_LIFT_COEFFICIENT_nT_0); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.18  WING_STALL_AOA 

WING_STALL_AOA  is  a  constant  defining  the  wing  stall  angle  of  attack. 

3.1.18.1  Initialization 

The  constant  WING_STALL_AOA  is  initialized  during  execution  of  the  CSU 
aefodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a  summary  of 
the  constant. 


#define  WING_STALL_AOA  (deg_to_rad(aero_data[17])) 


3.1.18.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.18.2.1  Algorithm 

The  WING_STALL_AOA  is  used  to  control  the  computation  of  the  unit  lift 
coefficient  of  the  virtual  wing  by  a  call  to  the  CSU 
virtual_wing_lift_coefficient.  The  call  to  this  CSU  is  commented  out. 


if  (alpha  >  WING_STALL_AOA  I  1  alpha  <  0.0) 
return  (0.0); 

else 

return  (((WING_LIFr_COEFFICIENT_nT_3  alpha  + 
WING_LIFT_COEFnCIENT_nT_2)  alpha  + 
WING_LIFT_COEFnCIENT_nT_l)  alpha  + 
WING_LIFT_COEFFICIENT_Frr_0); 
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See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.19  VSTAB_AREA 

VSTAB_AREA  is  a  constant  defining  the  effective  vertical  stabilator  area. 

3.1.19.1  Initialization 

The  constant  VSTAB_AREA  is  initialized  during  execution  of  the  CSU 
aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodynjnit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a  summary  of 
the  constant. 


#define  VSTAB_AREA 


aero_data[18] 


3.J..19.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.19.2.1  Algorithm 

VSTAB_AREA  is  used  to  compute  the  total  lift  of  the  vertical  stabilator  by  a 
call  to  CSU  compute_lift_drag_forces. 


lift_vstab  =  dynamic_pressure  *■  lift_coefficient_vstab  *  VSTAB_AREA; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.20  VSTAB_COP_AC_X 

VSTAB_COP_AC_X  is  a  constant  defining  the  location  in  the  x-axis  of  the 
center  of  pressure  of  the  vertical  stabilator  for  the  vehicle. 

3.1.20.1  Initialization 

The  constant  VSTAB_COP_AC_X  is  initialized  during  execution  of  the  CSU 
aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a  summary  of 
the  constant. 
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#define  VSTAB_COP_AC_X  aero_data[19] 


3.1.20.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.20.2.1  Algorithm 

VSTAB  COP  AC  X  is  used  to  initialize  the  location  in  the  x-axis  of  the 
center  of  pressure  for  the  vertical  stabilator  in  the  CSU  aerodyn_init. 


loc_ac_vstab_cop[X]  =  VSTAB_COP_AC_X; 


The  loc_ac_vstab_cop  vector  is  then  used  to  compute  the  body  forces  and 
moments  by  a  call  to  the  CSC  sum_body_forces_and_moments_about_ac. 

t 


vec_cross_prod(loc_ac_vstab_cop,  lift_body_vstab,  moment_body_vstab); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.21  VSTAB_COP_AC_Y 

VSTAB_COP_AC_Y  is  a  constant  defining  the  location  in  the  y-axis  of  the 
center  of  pressure  of  the  vertical  stabilator  for  the  vehicle. 

3.1.21.1  Initialization 

The  constant  VSTAB_COP_AC_Y  is  initialized  during  execution  of  the  CSU 
aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodynjnit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a  summary  of 
the  constant. 


#define  VSTAB_COP_AC_Y  aero_data[20] 


3.1.21.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 
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3.1.21.2.1  Algorithm 

VSTAB_COP_AC_Y  is  used  to  initialize  the  location  in  the  y-axis  of  the 
center  of  pressure  for  the  vertical  stabilator  in  the  CSU  aerodynjnit. 

loc_ac_vstab_cop[Y]  =  VSTAB_COP_AC_Y; 


The  loc_ac_vstab_cop  vector  is. then  used  to  compute  the  body  forces  and 
moments  by  a  call  to  the  CSC  sum_body_forces_and_moments_about_ac. 


vec_cross_prod(loc_ac_vstab_cop,  lift_body_vstab,  moment_body_vstab); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.22  VSTAB_COP_AC_Z 

VSTAB_COP_AC_Z  is  a  constant  defining  the  location  in  the  z-axis  of  the 
center  of  pressure  of  the  vertical  stabilator  for  the  vehicle. 

3.1.22.1  Initialization 

The  constant  VSTAB_COP_AC_Z  is  initialized  during  execution  of  the  CSU 
aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a  summary  of 
the  constant. 


#define  VSTAB_COP_AC_Z  aero_data[21] 

3.1.22.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.22.2.1  Algorithm 

VSTAB_COP_AC_Z  is  used  to  initialize  the  location  in  the  z-axis  of  the 
center  of  pressure  for  the  vertical  stabilator  in  the  CSU  aerodyn_init. 
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loc_ac_vstab_cop[Z]  =  VSTAB_COP_AC_Z; 


The  loc_ac_vstab_cop  vector  is  then  used  to  compute  the  body  forces  and 
moments  by  a  call  to  the  CSC  sum_body_forces_and_moments_about_ac. 


vec_cross_prod(loc_ac_vstab_cop,  lift_body_vstab,  moment_body_vstab); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.23  VSTAB_LIFT_COEFFICIENT_l 

VSTAB  LIFT_COEFFICIENT_l  is  a  constant  defining  the  second  coefficient 
of  the  vertical  stabilator  coefficient  polynomial. 

3.1.23.1  Initialization 

t 

The  constant  VSTAB_LIFT_COEFnCIENT_l  is  initialized  during  executmn 
of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execudon  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  VSTAB_LIFT_COEFFICIENT_l  aero_data[22] 


3.1.23.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.23.2.1  Algorithm 

VSTAB_LIFT_COEFFICIENT_l  is  used  to  compute  the  unit  lift  coefficient  of 
the  vertical  stabilator  in  the  CSU  vstab_lift_coefficient. 
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if  (abs(yaw)  >  VSTAB_STALL_SSA) 

yawval  =  sign(yawval)  VSTAB_STALL_SSA; 

else 

yawval  =  yaw; 

return  (VSTAB_LIFT_COEFFICIENT_l  yawval); 


The  vstabJift_coefficient  is  used  to  compute  the  total  vertical  stabilator  lift  by 
a  call  to  the  CSU  compute_lift_drag_coefficients. 


lift_coefficient_vstab  =  vstabJift_coefficient  (side_slip_angle); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.24  VSTAB_STALL_SSA 

f 

VSTAB_STALL_SSA  is  a  constant  defining  the  stall  angle  of  the  vertical 
stabilator. 

3.1.24.1  Initialization 

The  constant  VSTAB_STALL_SSA  is  initialized  during  execution  of  the  CSU 
aerodyn_init,  called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a  summary  of 
the  constant. 


#define  VSTAB_STALL_SSA  (deg_to_rad(aero_data[23])) 


3.1.24.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.24.2.1  Algorithm 

VSTAB_STALL_SSA  is  used  to  compute  the  unit  lift  coefficient  of  the 
vertical  stabilator  in  the  CSU  vstab_lift_coefficient. 
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if  (abs(yaw)  >  VSTAB_STALL_SSA) 

yawval  =  sign(yawval)  *  VSTAB_STALL_SSA; 

else 

yawval  =  yaw; 

return  (VSTAB_LIFT_COEFFICIENT_l  yawval); 


The  vstab_lift_coefficient  is  used  to  compute  the  total  vertical  stabilator  lift  by 
a  call  to  the  CSU  compute_lift_drag_coefficients. 


lift_coefficient_vstab  =  vstabJift_coefficient  (side_slip_angle); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.25  MAIN_ROTOR_COP_AC_X 
» 

MAIN_ROTOR_COP_AC_X  is  a  constant  defining  the  location  in  the  x-axis 
of  the  center  of  pressure  for  the  main  rotor. 

3.1.25.1  Initialization 

The  constant  MAIN_ROTOR_COP_AC_X  is  initialized  during  execution  of 
the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MAIN_ROTOR_COP_AC_X  aero_data[24] 


3.1.25.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.25.2.1  Algorithm 

MAIN_ROTOR_COP_AC_X  is  used  to  initialize  the  location  in  the  x-axis  of 
the  center  of  pressure  for  the  main  rotor  in  the  CSU  aerodynjnit. 
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loc_ac_main_rotor_cop[X]  =  MAIN_ROTOR_COP_AC_X; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.26  MAIN_ROTOR_COP_AC_Y 

MAIN_ROTOR_COP_AC_Y  is  a  constant  defining  the  location  in  the  y-axis 
of  the  center  of  pressure  for  the  main  rotor. 

3.1.26.1  Initialization 

The  constant  MAIN_ROTOR_COP_AC_Y  is  initialized  during  execution  of 
the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MAIN_ROTOR_COP_AC_Y  aero_data[25] 


3.1.26.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.26.2.1  Algorithm 

MAIN_ROTOR_COP_AC_Y  is  used  to  initialize  the  location  in  the  y-axis  of 
the  center  of  pressure  for  the  main  rotor  in  the  CSU  aerodyn_init. 

loc_ac_main_rotor_cop[Y]  =  MAIN_ROTOR_COP_AC_Y; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.27  MAIN_ROTOR_COP_AC_Z 

MAIN_ROTOR_COP_AC_Z  is  a  constant  defining  the  location  in  the  z-axis 
of  the  center  of  pressure  for  the  main  rotor. 

3.1.27.1  Initialization 

The  constant  MAIN_ROTOR_COP_AC_Z  is  initialized  during  execution  of 
the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 


-25- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 

aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MAIN_ROTOR_COP_AC_Z  aero_data[26] 


3.1.27.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.27.2.1  Algorithm 

MAIN_ROTOR_COP_AC_Z  is  used  to  initialize  the  location  in  the  z-axis  of 
the  center  of  pressure  for  the  main  rotor  in  the  CSU  aerodynjnit. 

loc_ac_main_rotor_cop[Z]  =  MAIN_ROTOR_COP_AC_Z; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.28  MAIN_ROTOR_MAX_THRUST 

MAIN_ROTOR_MAX_THRUST  is  a  constant  defining  the  maximum  thrust 
of  the  main  rotor  at  100  per  cent  rpm. 

3.1.28.1  Initialization 

The  constant  MAIN_ROTOR_MAX_THRUST  is  initialized  during  execution 
of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MAIN_ROTOR_MAX_THRUST  aero_data[27] 


3.1.28.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 
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3.1.28.2.1  Algorithm 

MAIN_ROTOR_MAX_THRUST  is  used  to  compute  main_rotor_thrust  in 
the  CSU  compute_rotor_forces_and_moments. 


main_rotor_thrust  =  power train_percent_shaft_speed  * 

controller_collective 

MAIN_ROTOR_MAX_THRUST; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.29  MAIN_ROTOR_MAST_TILT 

MAIN_ROTOR_MAST_TILT  is  a  constant  defining  the  angle  of  tilt  of  the 
main  rotor  mast. 

3,1.29.1  Initialization 

The  constant  MAIN_ROTOR_MAST_TILT  is  initialized  during  execution  of 
the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MAIN_ROTOR_MAST_TILT  (deg_to_rad(aero_data[28])) 


3.1.29.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.29.2.1  Algorithm 

MAIN_ROTOR_MAST_TILT  is  used  to  compute  sine  and  cosine  of  the  angle 
of  main  rotor  mast  tilt  in  the  CSU  aerodyn_init. 


MAIN_ROTOR_MAST_TILT_SIN  =  sin(MAIN_ROTOR_MAST_TILT); 
MAIN_ROTOR_MAST_TILT_COS  =  cos(MAIN_ROTOR_MAST_TILT); 


These  values  are  used  to  compute  the  forces  generated  by  the  main  rotor  on 
the  body  by  a  call  to  the  CSU  compute_rotor_forces_and_moments. 
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force_body_main_rotor[Y]  =  main_rotor_thrust  * 

MAIN_ROTOR_MAST_TILT_SIN; 

force_body_main_rotor[Z]  =  main_rotor_thrust  * 

MAIN_ROTOR_MAST_TILT_COS; 

See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.30  MAIN_ROTOR_MAX_LOAD_TORQUE 

MAIN_ROTOR_MAX_LOAD_TORQUE  is  a  constant  defining  the 
maximum  load  torque  of  the  main  rotor. 

3.1.30.1  Initialization 

The  constant  MAIN_ROTOR_MAX_LOAD_TORQUE  is  initialized  during 
execution  of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the 
CSU  aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 

#define  MAIN_ROTOR_MAX_LOAD_TORQUE  aero_data[29] 

3.1.30.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.30.2.1  Algorithm 

MAIN_ROTOR_MAX_LOAD_TORQUE  is  used  to  compute  the  load  torque 
of  the  main  rotor  by  a  call  to  the  CSU  compute_rotor_loads. 

main_rotor_load_torque  =  controller_collective  * 

MAIN_ROTOR_MAX_LOAD_TORQUE; 

The  main_rotor_load_torque  is  used  to  compute  the  engine  torque  by  a  call 
to  the  CSU  compute_engine_torque. 
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engine_siinul(main_rotor_load_torque, 

tail_rotor_load_torque,  altitude); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.31  MAIN_ROTOR_MAX_PITCH_MOMENT 

MAIN_ROTOR_MAX_PITCH_MOMENT  is  a  constant  defining  the 
maximum  pitching  moment  of  .the  main  rotor. 

3.1.31.1  Initialization 

The  constant  MAIN_ROTOR_MAX_PITCH_MOMENT  is  initialized  during 
execution  of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the 
CSU  aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MAIN_ROTOR_MAX_PITCH_MOMENT  aero_data[30] 


3.1.31.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.31.2.1  Algorithm 

MAIN_ROTOR_MAX_PITCH_MOMENT  is  used  to  compute  the  pitching 
moment  on  the  body  generated  by  the  main  rotor  by  a  call  to  the  CSU 
compute_rotor_forces_and_moments. 


moment_body_main_rotor[X]  = 

-  controller_cyclic_pitch  *  MAIN_ROTOR_MAX_PITCH_MOMENT; 


The  components  are  summed  for  the  total  moment  on  the  body  by  a  call  to 
the  CSU  sum_body_forces_and_moments_about_ac. 
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vecjnit  (moment_body); 

vec_add  (moment_body,  moment_body_main_rotor,  moment_body); 
vec_add  (n\oment_body,  moment_body_tail_rotor,  moment_body); 
vec_add  (moment_body,  moinent_body_virtual_wing,  moment_body); 
vec_add  (moment_body,  moment_body_vstab,  moment_body); 
vec_add  (moment_body,  moment_body_cg,  moment_body); 
vec_add  (moment_body,  ground_torque,  inoment_body); 
vec_add  (moment_body,  moinent_body_damping,  moment_body); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.32  MAIN_ROTOR_MAX_ROLL_MOMENT 

MAIN_ROTOR_MAX_ROLL_MOMENT  is  a  constant  defining  the 
maximum  rolling  moment  of  the  main  rotor. 

3.1.32.1  Initialization 

The  constant  MAIN_ROTOR_MAX_ROLL_MOMENT  is  initialized  during 
execution  of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the 
CSU  aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MAIN_ROTOR_MAX_ROLL_MOMENT  aero_data[31] 

3.1.32.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.32.2.1  Algorithm 

MAIN_ROTOR_MAX_ROLL_MOMENT  is  used  to  compute  the  rolling 
moment  on  the  body  generated  by  the  main  rotor  by  a  call  to  the  CSU 
compute_rotor_forces_and_moments. 

moment_body_main_rotor[Y]  = 

controller _cyclic_roll  MAIN_ROTOR_MAX_ROLL_MOMENT; 


The  components  are  summed  for  the  total  moment  on  the  body  by  a  call  to 
the  CSU  sum_body_forces_and_moments_about_ac. 
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vecjnit  (moment_body); 

vec_add  (moment_body,  moment_body_main_rotor,  moment_body); 
vec_add  (moment_body,  moment_body_tail_rotor,  moment_body); 
vec_add  (moment_body,  moment_body_virtual_wing,  moment_body); 
vec_add  (moment_body,  moment_body_vstab,  moment_body); 
vec_add  (moment_body,  inoment_body_cg,  moment_body); 
vec_add  (moment_body,  ground_torque,  inoment_body); 
vec_add  (inoment_body,  moment_body_damping,  moment_body); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.33  MAIN_ROTOR_TORQUE_COUPLING_GAIN 

MAIN_ROTOR_TORQUE_COUPLING_GAIN  is  a  constant  defining  the 
torque  moment  generated  by  the  main  rotor. 

3.1.33.1  Initialization 

The  constant  MAIN_ROTOR_TORQUE_COUPLING_GAIN  is  initialized 
during  execution  of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution 
of  the  CSU  aerodyn_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.1.  - 
Aerodynamics  Data  Array  for  a  summary  of  the  constant. 


#define  MAIN_ROTOR_TORQUE_COUPLING_GAIN  aero_data[32] 


3.1.33.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.33.2.1  Algorithm 

MAIN_ROTOR_TORQUE_COUPLING_GAIN  is  used  to  compute  the  torque 
moment  on  the  body  generated  by  the  main  rotor  by  a  call  to  the  CSU 
compute_rotor_forces_and_moments. 


moment_body_main_rotor[Z]  = 

-  main_rotor_load_torque 
MAIN_ROTOR_TORQUE_COUPLING_GAIN; 
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The  components  are  summed  for  the  total  moment  on  the  body  by  a  call  to 
the  CSU  sum_body_forces_and_moments_about_ac. 


vecjnit  (moment_body); 

vec_add  (moment_body,  moment_body_main_rotor,  moment_body); 
vec_add  (moment_body,  moment_body_tail_rotor,  moment_body); 
vec_add  (moment_body,  moment_body_virtual_wing,  moment_body); 
vec_add  (moment_body,  moment_body_vstab,  moment_body); 
vec_add  (moment_body,  moment_body_cg,  moment_body); 
vec_add  (moment_body,  ground_torque,  moment_body); 
vec_add  (moment_body,  moment_body_damping,  moment_body); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.34  MAIN_ROTOR_GROUND_EFFECT_FACTOR 

MAIN_ROTOR_GROUND_EFFECT_FACTOR  is  a  constant  defining  the 
ground  effect  on  the  main  rotor. 

3.1.34.1  Initialization 

The  constant  MAIN_ROTOR_GROUND_EFFECT_F ACTOR  is  initialized 
during  execution  of  the  CSU  aerod5m_init,  called  by  CSC  rwa_init.  Execution 
of  the  CSU  aerodyn_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.1.  - 
Aerodynamics  Data  Array  for  a  summary  of  the  constant. 


#define  MAIN_ROTOR_GROUND_EFFECT_F ACTOR  aero_data[33] 


3.1.34.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.34.2.1  Algorithm 

MAIN_ROTOR_GROUND_EFFECT_FACTOR  is  used  to  compute  the 
ground  effect  force  generated  during  proximity  of  the  rotor  and  the  ground  by 
a  call  to  the  CSC  interact_with_ground. 


-32- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


force_ground_effect[Z]  =  main_rotor_thrust 

MAIN_ROTOR_GROUND_EFFECT_F ACTOR 
/  (cig_altitude_above_gnd()  +  1.0); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.35  TAIL_ROTOR_COP_AC_X 

TAIL_ROTOR_COP_AC_X  is  a. constant  defining  the  location  in  the  x-axis  of 
the  center  of  pressure  of  the  tail  rotor  for  the  vehicle. 

3.1.35.1  Initialization 

The  constant  TAIL_ROTOR_COP_AC_X  is  initialized  during  execution  of 
the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
svimmary  of  the  constant. 


#define  TAIL_ROTOR_COP_AC_X  aero_data[34] 


3.1.35.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.35.2.1  Algorithm 

TAIL_ROTOR_COP_AC_X  is  used  to  initialize  the  location  in  the  x-axis  of 
the  center  of  pressure  for  the  tail  rotor  by  a  call  to  the  CSU  aerodyn_init. 

loc_ac_tail_rotor_cop[X]  =  TAIL_ROTOR_COP_AC_X; 


The  loc_ac_tail_rotor_cop  vector  is  then  used  to  compute  and  sum  the  body 
forces  and  moments  by  a  call  to  the  CSU 
sum_body_forces_and_moments_ac. 
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vec_cross_prod(loc_ac_tail_rotor_cop,  force_body_tail_rotor, 

moment_body_tail_rotor); 

vec_cross_prod(loc_ac_virtual_wing_cop,lift_body_virtual_wing, 

moinent_body_virtual_wing); 

vec_cross_prod(loc_ac_vstab_cop,  lift_body_vstab,  moment_body_vstab); 
vec_cross_prod(loc_ac_cg,  gravity_force_body,  moment_body_cg); 

vecjnit  (moment_body); 

vec_add  (moment_body,  moment_body_main_rotor,  moment_body); 
vec_add  (moment_body,  moment_body_tail_rotor,  moment_body); 
vec_add  (moment_body,  moment_body_virtual_wing,  moment_body); 
vec_add  (moment_body,  inoinent_body_vstab,  mon\ent_body); 
vec_add  (moinent_body,  naoment_body_cg,  moment_body); 
vec_add  (monrient_body,  ground_torque,  moment_body); 
vec_add  (moment_body,  inoment_body_damping,  n\oment_body); 

See  APPENDIX  B  for  a  complete  source  code  listing. 

t 

3.1.36  TAIL_ROTOR_COP_AC_Y 

TAIL_ROTOR_COP_AC_Y  is  a  constant  defining  the  location  in  the  y-axis  of 
the  center  of  pressure  of  the  tail  rotor  for  the  vehicle. 

3.1.36.1  Initialization 

The  constant  TAIL_ROTOR_COP_AC_Y  is  initialized  during  execution  of 
the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
siunmary  of  the  constant. 

#define  TAIL_ROTOR_COP_AC_Y  aero_data[35] 


3.1.36.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.36.2.1  Algorithm 

TAIL_ROTOR_COP_AC_Y  is  used  to  initialize  the  location  in  the  y-axis  of 
the  center  of  pressure  for  the  tail  rotor  by  a  call  to  the  CSU  aerodyn_init. 
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loc_ac_tail_rotor_cop[Y]  =  TAIL_ROTOR_COP_AC_Y; 


I 


The  loc_ac_tail_rotor_cop  vector  is  then  used  to  compute  and  sum  the  body 
forces  and  moments  by  a  call  to  the  CSU 
sum_body_forces_and_moments_ac. 


vec_cross_prod(loc_ac_tail_rotor_cop,  force_body_tail_rotor, 

moment_body_tail_rotor); 

vec_cross_prod(loc_ac_virtual_wing_cop,lift_body_virtual_wing, 

moment_body_virtual_wing); 

vec_cross_prod(loc_ac_vstab_cop,  lift_body_vstab,  moment_body_vstab); 
vec_cross_prod(loc_ac_cg,  gravity _force_body,  moment_body_cg); 

vec_mit  (moment_body); 

vec_add  (moment_body,  moment_body_main_rotor,  moment_body); 
vec_add  (moment_body,  moment_body_tail_rotor,  moment_body); 

'  vec_add  (moment_body,  moment_body_virtual_wing,  moment_body); 
vec_add  (moment_body,  moment_body_vstab,  moment_body); 
vec_add  (moment_body,  moment_body_cg,  moment_body); 
vec_add  (moment_body,  ground_torque,  moment_body); 
vec_add  (moment_body,  moment_body_damping,  moment_body); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.37  TAIL_ROTOR_COP_AC_Z 

TAIL_ROTOR_COP_AC_Z  is  a  constant  defining  the  location  in  the  z-axis  of 
the  center  of  pressure  of  the  tail  rotor  for  the  vehicle. 

3.1.37.1  Initialization 

The  constant  TAIL_ROTOR_COP_AC_Z  is  initialized  during  execution  of 
the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  TAIL  ROTOR_COP_AC_Z 


aero_data[36] 
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3.1.37.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.37.2.1  Algorithm 

TAIL_ROTOR_COP_AC_Z  is  used  to  initialize  the  location  in  the  z-axis  of 
the  center  of  pressure  for  the  tail  rotor  by  a  call  to  the  CSU  aerodyn_init. 

loc_ac_tail_rotor_cop[Z]  =  TAIL_R0T0R_C0P_AC_Z; 


The  loc_ac_tail_rotor_cop  vector  is  then  used  to  compute  and  sum  the  body 
forces  and  moments  by  a  call  to  the  CSU 
sum_body_forces_and_moments_ac. 


.  vec_cross_prod(loc_ac_tail_rotor_cop,  force_body_tail_rotor, 

moment_body_tail_rotor); 

vec_cross_prod(loc_ac_virtual_wing_cop,lift_body_virtual_wing, 

moment_body_virtual_wing); 

vec_cross_prod(loc_ac_vstab_cop,  lih_body_vstab,  moment_body_vstab); 
vec_cross_prod(loc_ac_cg,  gravity _force_body,  moment_body_cg); 

vec_init  (moment_body); 

vec_add  (moment_body,  moment_body_main_rotor,  moment_body); 
vec_add  (moment_body,  moment_body_tail_rotor,  moment_body); 
vec_add  (moment_body,  moment_body_virtual_wing,  moment_body); 
vec_add  (moment_body,  moment_body_vstab,  moment_body); 
vec_add  (moment_body,  moment_body_cg,  moment_body); 
vec_add  (moment_body,  ground_torque,  moment_body); 
vec_add  (moment_body,  moment_body_damping,  moment_body); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.38  TAIL_R0T0R_MAX_THRUST 

TAIL_ROTOR_MAX_THRUST  is  a  constant  defining  the  maximum  thrust 
of  the  tail  rotor. 

3.1.38.1  Initialization 

The  constant  TAIL_ROTOR_MAX_THRUST  is  initialized  during  execution 
of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
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aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  TAIL_ROTOR_MAX_THRUST  aero_data[37] 


3.1.38.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.38.2.1  Algorithm 

TAIL_ROTOR_MAX_THRUST  is  used  to  compute  the  tail  rotor  thrust  and 
its  force  on  the  body  of  the  vehicle  by  a  call  to  the  CSU 

compute_rotor_forces_and_moments. 


'  tail_rotor_thrust  =  power train_percent_shaft_speed  * 

controller_tail_rotor  *  TAIL_ROTOR_MAX_THRUST; 

force_body_tail_rotor[X]  =  tail_rotor_thrust; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.39  TAIL_ROTOR_MAX_LOAD_TORQUE 

TAIL_ROTOR_MAX_LOAD_TORQUE  is  a  constant  defining  the  maximum 
load  torque  of  the  tail  rotor  at  100  percent  rpm. 

3.1.39.1  Initialization 

The  constant  TAIL_ROTOR_MAX_LOAD_TORQUE  is  initialized  during 
execution  of  the  CSU  aerodynjnit,  called  by  CSC  rwa Jnit.  Execution  of  the 
CSU  aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  TAIL_ROTOR_MAX_LOAD_TORQUE  aero_data[38] 


3.1.39.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 
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3.1.39.2.1  Algorithm 

TAIL_ROTOR_MAX_LOAD_TORQUE  is  used  to  load  torque  for  the  tail 
rotor  by  a  call  to  the  CSU  compute_rotor_loads. 


tail_rotor_load_torque  =  abs  (controller_tail_rotor) 

TAIL_ROTOR_MAX_LOAD_TORQUE; 


The  tail_rotor_load_torque  is  used  to  compute  the  engine  torque  by  a  call  to 
the  CSU  compute_engine_torque. 


engine_simul(main_rotor_load_torque, 

tail_rotor_load_torque,  altitude); 


S^e  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.40  P_DRAG_COEFF_CONST 

P_DRAG_COEFF_CONST  is  one  of  five  constants  defining  the  coefficients  of 
the  parasitic  drag  profile  cubic  function  used  to  compute  the  parasitic  drag 
profile  for  the  vehicle. 

3.1.40.1  Initialization 

The  constant  P_DRAG_COEFF_CONST  is  initialized  during  execution  of  the 
CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  P_DRAG_COEFF_CONST  aero_data[39] 


3.1.40.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.40.2.1  Algorithm 

P_DRAG_COEFF_CONST  is  used  to  compute  the  parasitic  drag  profile 
coefficient  from  a  cubic  function  by  a  call  to  the  CSU  find_cubic_function. 
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The  p_drag_fit_coeff  vector  is  initialized  to  zero,  then  computed.  If  an  error, 
especially  the  result  is  0.0,  an  error  statement  is  generated.  The 
p_drag_fit_coeff  vector  is  computed  by  a  call  to  the  CSU  aerodynjnit. 


for  (i=0;  i<9;  i++)  I*  Set  parasite  drag  profile  *! 

{ 

p_drag_fit_coeff[i]  =  0.0; 

} 

if  (find_cubic_func  (0.0,  P_DRAG_COEFF_CONST, 

P_DRAG_TAS_BREAK,  P_DRAG_COEFF_BREAK, 
P_DRAG_TAS_MAX,  P_DRAG_COEFF_MAX, 

0.5,  p_drag_fit_coeff)  !=  TRUE) 

{ 

fprintf  (stderr,  "AERODYN;  Error  -  unable  to  fit  p_drag  functionXn"); 

} 

The  p_drag_fit_coeff  vector  is  then  used  to  compute  the  total 
incompressibie_drag_coefficient  by  a  call  to  the  CSU 
compute_lift_drag_coefficients. 

lift_coeffident_vstab  =  vstab_lift_coefficient  (side_slip_angle); 

I*  Computing  virtual  wing  coefficient  as  independent  of  AOA  *! 

lift_coefficient_virtual_wing  =  LIFT_COEFF_VIRTUAL_WING; 

/*  virtual_wing_lift_coefficient  (angle_of_attack);  * ! 

parasite_drag_coefficient  =  cubic_func  (true_airspeed,  p_drag_fit_coeff); 

if  (true_airspeed  >  0.0  &&  angle_of_attack  >  0.0)  I*  speed  brake  *! 

multiplier  =  5.0  true_airspeed  *  sin(angle_of_attack); 
if  (multiplier  >1.0) 

parasite_drag_coefficient  multiplier; 

} 

oswald_efficiency_factor  =  OSWALD_EFFIC_FACTOR; 

induced_drag_coefficient  =  INDUCED_DRAG_COEFF; 

total_incompressible_drag_coefficient  =  parasite_drag_coefficient  + 

induced_drag_coefficient; 
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The  total  drag  is  computed  by  a  call  to  the  CSU  compute_lift_drag_forces. 


total_drag  =  total_incompressible_drag_coefficient  *  dynamic_pressure  * 
TOTAL_WETTED_SURFACE_AREA; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.41  P_DRAG_TAS_BREAK 

P_DRAG_TAS_BREAK  is  one  of  five  constants  defining  the  coefficients  of 
the  parasitic  drag  profile  cubic  function  used  to  compute  the  parasitic  drag 
profile  for  the  vehicle. 

3.1.41.1  Initialization 

The  constant  P_DRAG_TAS_BREAK  is  initialized  during  execution  of  the 
CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  P_DRAG_TAS_BREAK  aero_data[40] 


3.1.41.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.41.2.1  Algorithm 

See  paragraph  3.1.40. 

P_DRAG_TAS_BREAK  is  used  to  control  computation  of  the  y-axis  element 
of  the  drag  force  by  a  call  to  the  CSU 
transform_lift_drag_forces_to_body_coordinates. 
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virtual_wing_force[Z]  =  lift_virtual_wing;  /*  [H,  D,  L]  */ 

vstab_force[X]  =  lift_vstab; 
drag_force[Y]  =  -total_drag; 

if  (true_airspeed  <  P_DRAG_TAS_BREAK)  /'^jwc8/90*/ 

drag_force[Y]  -=  sin(pitch)  *  50000; 

vec_mat_mul  (virtual_wing_force,  velocity_to_body, 
lift_body_virtual_wing); 

vec_mat_mul  (vstabjorce,  velocity_to_body,  lift_body_vstab); 
vec_mat_mul  (dragjorce,  velocity_to_body,  drag_body); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.42  P_DRAG_COEFF_BREAK 

P_DRAG_COEFF_BREAK  is  one  of  five  constants  defining  the  coefficients  of 
trie  parasitic  drag  profile  cubic  function  used  to  compute  the  parasitic  drag 
profile  for  the  vehicle. 

3.1.42.1  Initialization 

The  constant  P_DRAG_COEFF_BREAK  is  initialized  during  execution  of  the 
CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  P_DRAG_COEFF_BREAK  aero_data[41] 


3.1.42.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 
3.1.42.2.1  Algorithm 

See  paragraph  3.1.40. 

See  APPENDIX  B  for  a  complete  source  code  listing. 


41- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 

3.1.43  P_DRAG_TAS_MAX 

P_DRAG_TAS_MAX  is  one  of  five  constants  defining  the  coefficients  of  the 
parasitic  drag  profile  cubic  function  used  to  compute  the  parasitic  drag  profile 
for  the  vehicle. 

3.1.43.1  Initialization 

The  constant  P_DRAG_TAS_MAX  is  initialized  during  execution  of  the  CSU 
aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a  summary  of 
the  constant. 


#define  P  DRAG_TAS_MAX  aero_data[42] 


3A.43.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.43.2.1  Algorithm 
See  paragraph  3.1.40. 

See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.44  P_DRAG_COEFF_MAX 

P_DRAG_COEFF_MAX  is  one  of  five  constants  defining  the  coefficients  of 
the  parasitic  drag  profile  cubic  function  used  to  compute  the  parasitic  drag 
profile  for  the  vehicle. 

3.1.44.1  Initialization 

The  constant  P_DRAG_COEFF_MAX  is  initialized  during  execution  of  the 
CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  P_DRAG_COEFF_MAX  aero_data[43] 
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3.1.44.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.44.2.1  Algorithm 
See  paragraph  3.1.40. 

See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.45  TOTAL_WETTED_SURFACE_AREA 

TOTAL_WETTED_SURFACE_AREA  is  a  constant  defining  the  total  wetted 
surface  area  of  the  vehicle. 

3.1.45.1  Initialization 

The  constant  TOTAL_WETTED_SURFACE_AREA  is  initialized  during 
execution  of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the 
CBU  aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 

#define  TOTAL_WETTED_SURFACE_AREA  aero_data[44] 

3.1.45.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.45.2.1  Algorithm 

TOTAL_WETTED_SURFACE_AREA  is  used  to  compute  the  total  drag  by  a 
call  to  the  CSU  compute_lift_drag_forces. 

total_drag  =  total_incompressible_drag_coefficient  *  dynamic_pressure  * 
TOT  AL_WETTE  D_SURF  ACE_  ARE  A; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.46  MAX_ATT_CTL_ANGLE_STOP 

MAX_ATT_CTL_ANGLE_STOP  is  a  constant  defining  the  maximum 
attitude  control  angle  stop. 
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3.1.46.1  Initialization 

The  constant  MAX_ATT_CTL_ANGLE_STOP  is  initialized  during  execution 
of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MAX_ATT_CTL_ANG,LE_STOP  aero_data[45] 


3.1.46.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.46.2.1  Algorithm 

MAX_ATT_CTL_ANGLE_STOP  is  used  to  limit  the  maximum  attitude 
control  angle  for  the  simple  flight  mode  by  a  call  to  the  CSU 
compute_stab_augmentation_gains. 


#if  ATT_DAMPING_MODE_SIMPLE 

if  (true.airspeed  >  HOVER_SLOW_LIMIT  ) 

MAX_ATT_CTL_  ANGLE  = 

log(  true_airspeed  )  *  MAX_ATT_DAMPING_FACTOR  ; 
else  if  (true_airspeed  <  -HOVER_SLOW_LIMrr  ) 

MAX_ATT_CTL_  ANGLE  = 

log(  -true_airspeed  )  *  MAX_ATT_DAMPING_F ACTOR  ; 

else 

MAX_ATT_CTL_ ANGLE  =  MAX_ATT_CTL_ANGLE_STOP  ; 
MAX_ATT_CTL_ ANGLE  =  deg_to_rad(  MAX_ATT_CTL_ ANGLE  ); 

#endif 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.47  MAX_ATT_DAMPING_FACTOR 
MAX_ATT_DAMPING_F ACTOR  is  a  constant  defining  the 
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3.1.47.1  Initialization 

The  constant  MAX_ATT_DAMPING_FACTOR  is  initialized  during 
execution  of  the  CSU  aerodyn_init,  called  by  CSC  rwajnit.  Execution  of  the 
CSU  aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MAX_ATT_DAMPING^F ACTOR  aero_data[46] 


3.1.47.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.47.2.1  Algorithm 

MAX_ATT_DAMPING_F ACTOR  is  used  to  compute  the  maximum  attitude 
control  angle  for  the  simple  flight  mode  by  a  call  to  the  CSU 
compute_stab_augmentation_gains. 


#if  ATT_DAMPING_MODE_SIMPLE 

if  (true.airspeed  >  HOVER_SLOW_LIMIT  ) 

MAX_ATT_CTL_  ANGLE  = 

log(  true_airspeed  )  *  MAX_ATT_DAMPING_FACTOR  ; 
else  if  (true_airspeed  <  -HOVER_SLOW_LIMrr  ) 

MAX_ATT_CTL_  ANGLE  = 

log(  -true_airspeed  )  *  MAX_ATT_DAMPING_F ACTOR  ; 

else 

MAX_ATT_CTL_ ANGLE  =  MAX_ATT_CTL_ANGLE_STOP  ; 
MAX_ATT_CTL_ ANGLE  =  deg_to_rad(  MAX_ATT_CTL_ ANGLE  ); 

#endif 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.48  HOVER_SLOW_LIMIT 

HOVER_SLOW_LIMIT  is  a  constant  defining  the  slow  limit  speed  in  hover. 
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3.1.48.1  Initialization 

The  constant  HOVER_SLOW_LIMIT  is  initialized  during  execution  of  the 
CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  HOVER_SLOW_LIMIT  aero_data[47] 


3.1.48.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.48.2.1  Algorithm 

HOVER_SLOW_LIMIT  is  used  to  control  computation  of  the  maximum 
attitude  control  angle  for  the  simple  flight  mode  by  a  call  to  the  CSU 
compute_stab_augmentation_gains. 


#if  ATT_DAMPING_MODE_SIMPLE 

if  (true.airspeed  <  HOVER_SLOW_LIMIT) 

{ 

if  (true_airspeed  >  -HOVER_SLOW_LIMIT) 
MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_SLOW  ; 
else  if  (true_air speed  >  -HOVER_MED_LIMrT) 
MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_MED; 

else 

MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_NORM  ; 

} 

else  if  (true_airspeed  <  HOVER_MED_LIMrr) 
MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_MED  ; 

else 

MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_NORM  ; 

#endif 
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#if  ATT_DAMPING_MODE_SIMPLE 

if  (true_airspeed  >  HOVER_SLOW_LIMIT  ) 

MAX_ATT_CTL_  ANGLE  = 

log(  true_airspeed  )  *  MAX_ATT_DAMPING_FACTOR  ; 
else  if  (true_airspeed  <  -HOVER_SLOW_LIMIT  ) 

MAX_ATT_CTL_  ANGLE  = 

log(  -true_airspeed  )  *  MAX_ATT_DAMPING_FACTOR  ; 

else 

MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_STOP  ; 

MAX_ATT_CTL_  ANGLE  = 

deg_to_rad(  MAX_ATT_CTL_ ANGLE  ); 

:#endif 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.49  HOVER_AUG_PITCH_RESET_VALUE 

H'0VER_AUG_PITCH_RESET_VALUE  is  a  constant  defining  the  value  for 
the  hover  augmentation  pitch  integrator  is  reset  when  hover  hold  is  turned 
on. 


3.1.49.1  Initialization 

The  constant  HOVER_AUG_PITCH_RESET_VALUE  is  initialized  during 
execution  of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the 
CSU  aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  HOVER_AUG_PITCH_RESET_VALUE  aero_data[48] 


3.1.49.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.49.2.1  Algorithm 

HOVER_AUG_PITCH_RESET_VALUE  is  used  to  compute  the  hover 
augmentation  pitch  integrator  by  a  call  to  the  CSU 
compute_stab_augmentation_gains. 
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if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

hover_hold_turned_on  =  TRUE  ; 

/’'■You  should  already  be  "hovering"  (airspeed  <10  knots) 
for  hover  hold  to  show  little  visible  swaying.  * ! 

hover_aug_roll_integrator  =  0.0  ; 
hover_aug_pitch_integrator  = 

HOVER_AUG_PITCH_RESET_VALUE  ; 


hover_aug_pitch_integrator  += 

HOVER_AUG_PITCH_I_GAIN  velocity_vector[Y]; 
,  hover_aug_pitch_integrator  = 

limiter(-0.2,hover_aug_pitch_integrator,0.2); 
hover_aug_pitch_angle  =  HOVER_AUG_PITCH_P_GAIN  * 
veloci  ty_vector  [  Y] 

+  hover_aug_pitch_integrator; 
hover_aug_pitch_angle  =  limiter  (-MAX_ATT_CTL_ANGLE, 

hover_aug_pi  tch_angle, 
MAX_ATT_CTL_ANGLE); 

'  Y 

else 

{ 

#ifdef  notdef 

hover_aug_roll_integrator  =  0.0;  /*  added  8/31/89  (jwc) ’'■/ 

hover_aug_pitch_integrator  =  0.0; 

#endif 

} 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.50  MAX_ATT_CTL_ANGLE_NORM 

MAX_ATT_CTL_ANGLE_NORM  is  a  constant  defining  the  normal  setting 
for  the  maximum  attitude  control  angle. 
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3.1.50.1  Initialization 

The  constant  MAX_ATT_CTL_ANGLE_NORM  is  initialized  during 
execution  of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the 
CSU  aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MAX_ATT_CTL_ANGLE_NORM  (deg_to_rad  (aero_data[49])) 


3.1.50.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.50.2.1  Algorithm 

MAX_ATT_CTL_ANGLE_NORM  is  used  to  initialize  the  maximum 
attitude  control  angle  to  the  normal  setting  for  the  simple  flight  mode  by  a 
call  to  the  CSU  compute_stab_augmentation_gains. 


if  (  !hover_hold_turned_on  ) 

{ 

hover_hold_turned_on  =  TRUE  ; 


#if  ATT_DAMPING_MODE_SIMPLE 

if  (true_airspeed  <  HOVER_SLOW_LIMrT) 

{ 

if  (true_airspeed  >  -HOVER_SLOW_LIMIT) 
MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_SLOW  ; 
else  if  (true_airspeed  >  -HOVER_MED_LIMIT) 
MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_MED; 

else 


MAX_ATT_CTL_ANGLE  = 

MAX_ATT_CTL_ANGLE_NORM  ; 

} 

else  if  (true_air speed  <  HOVER_MED_LIMIT) 
MAX_ATT_CTL_  ANGLE  = 

MAX  ATT_CTL_ANGLE_MED  ; 
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else 

MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_NORM  ; 

#endif 

} 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.51  MAX_ATT_CTL_ANGLE_MED 

MAX_ATT_CTL_ANGLE_MED  is  a  constant  defining  the  medium  setting 
for  the  maximum  attitude  control  angle. 

3.1.51.1  Initialization 

The  constant  MAX_ATT_CTL_ANGLE_MED  is  initialized  during  execution 
of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execudon  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MAX_ATT_CTL_ANGLE_MED  (deg_to_rad  (aero_data[50])) 


3.1.51.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.51.2.1  Algorithm 

MAX_ATT_CTL_ANGLE_MED  is  used  to  initialize  the  maximum  attitude 
control  angle  to  the  normal  setting  for  the  simple  flight  mode  by  a  call  to  the 
CSU  compute_stab_augmentation_gains. 


if  (  !hover_hold_turned_on  ) 

{ 

hover_hold_turned_on  =  TRUE  ; 


#if  ATT_DAMPING_MODE_SIMPLE 

if  (true_airspeed  <  HOVER_SLOW_LIMIT) 

if  (true_airspeed  >  -HOVER_SLOW_LIMIT) 
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#endif 


MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_SLOW  ; 
else  if  (true_airspeed  >  -HOVER_MED_LIMIT) 
MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_MED; 

else 

MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_NORM  ; 

} 

else  if  (true_airspeed  <  HOVER_MED_LIMIT) 
MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_MED  ; 

else 

MAX_ATT_CTL_  ANGLE  = 

MAX  ATT  CTL  ANGLE_NORM  ; 


} 


See  APPENDIX  B  for  a  complete  source  code  listing. 


3.1.52  MAX_ATT_CTL_ANGLE_SLOW 

MAX_ATT_CTL_ANGLE_SLOW  is  a  constant  defining  the  slow  setting  for 
the  maximum  attitude  control  angle. 


3.1.52.1  Initialization 

The  constant  MAX_ATT_CTL_ANGLE_SLOW  is  initialized  during 
execution  of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the 
CSU  aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  MAX_ATT_CTL_ANGLE_SLOW  (deg_to_rad  (aero_data[51])) 


3.1.52.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.52.2.1  Algorithm 

MAX_ATT_CTL_ANGLE_SLOW  is  used  to  initialize  the  maximum  attitude 
control  angle  to  the  slow  setting  for  the  simple  flight  mode  by  a  call  to  the 
CSU  compute_stab_augmentation_gains. 


-51- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


if  (  !hover_hold_turned_on  ) 

{ 

hover_hold_turned_on  =  TRUE  ; 


#if  ATT_DAMPING_MODE_SIMPLE 

if  (true_airspeed  <  HOVER_SLOW_LIMIT) 

{ 

if  (true_airspeed  >  -HOVER_SLOW_LIMIT) 
MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_SLOW  ; 
else  if  (true_airspeed  >  -HOVER_MED_LIMIT) 
MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_MED; 

else 

MAX_ATT_CTL_  ANGLE  = 

’  MAX_ATT_CTL_ANGLE_NORM  ; 

} 

else  if  (true_airspeed  <  HOVER_MED_LIMIT) 
MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_MED  ; 

else 

MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_NORM  ; 


#endif 


} 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.53  HOVER_MED_LIMIT 

HOVER_MED_LIMIT  is  a  constant  defining  the  medium  speed  limit  for 
hover. 


3.1.53.1  Initialization 

The  constant  HOVER_MED_LIMIT  is  initialized  during  execution  of  the  CSU 
aerodynjnit,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a  summary  of 
the  constant. 
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#define  HOVER_MED_LIMIT 


aero_data[52] 


3.1.53.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.53.2.1  Algorithm 

HOVER_MED_LIMIT  is  used  to  control  the  computation  of  the  maximum 
attitude  control  angle  in  the  simple  flight  mode  by  a  call  to  the  CSU 
compute_stab_augmentation_gains. 


if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 


#if  ATT_DAMPING_MODE_SIMPLE 

if  (true_airspeed  <  HOVER_SLOW_LIMrr) 

{ 

if  (true_airspeed  >  -HOVER_SLOW_LIMIT) 
MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_SLOW  ; 
else  if  (true_airspeed  >  -HOVER_MED_LIMrr) 
MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_MED; 

else 

MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_NORM  ; 

} 

else  if  (true_airspeed  <  HOVER_MED_LIMIT) 
MAX_ATT_CTL_  ANGLE  = 

MAX_ATT_CTL_ANGLE_MED  ; 

else 

MAX_ATT_CTL_  ANGLE  = 
MAX_ATT_CTL_ANGLE_NORM  ; 

#endif 

} 


See  APPENDIX  B  for  a  complete  source  code  listing. 
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3.1.54  ATT_CTL_PITCH_P_GAIN 

ATT_CTL_PITCH_P_GAIN  is  a  constant  defining  the  slope  for  the  attitude 
control  pitch  command  equation. 

3.1.54.1  Initialization 

The  constant  ATT_CTL_PITCH_P_GAIN  is  initialized  during  execution  of 
the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  ATT_CTL_PITCH_P_GAIN  aero_data[53] 


3.1.54.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.54.2.1  Algorithm 

ATT_CTL_PITCH_P_GAIN  is  used  to  compute  the  attitude  control  pitch 
command  by  a  call  to  the  CSU  set_pitch_attitude. 


a  t  ti  tude_con  tr  ol_pi  tch_in  tegr  a  tor  + = 

ATT_CTL_PITCH_I_GAIN  (pitch  -  angle); 
a  ttitude_control_pitch_integr  a  tor  = 

limiter  (-0.1,  attitude_control_pitch_integrator,  0.1); 
attitude_control_pitch_command  =  ATT_CTL_PITCH_P_GAIN  * 

(pitch  -  angle); 

attitude_control_pitch_command  +=  attitude_control_pitch_integrator; 
attitude_control_pitch_command  =  limiter  ( 

-MAX_STAB_AUG_PITCH_ROLL_CONTROL, 
attitude_control_pitch_command, 
MAX_STAB_AUG_PITCH_ROLL_CONTROL); 
return  (attitude_control_pitch_command); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.55  ATT_CTL_PITCH_I_GAIN 

ATT_CTL_PITCH_I_GAIN  is  a  constant  defining  the  slope  for  the  attitude 
control  pitch  integrator  equation. 
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3.1.55.1  Initialization 

The  constant  ATT_CTL_PITCH_I_GAIN  is  initialized  during  execution  of 
the  CSU  aerodynjnih  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 

#define  ATT_CTL_PITCH_I_GAIN  aero_data[54] 

3.1.55.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.55.2.1  Algorithm 

ATT_CTL_PITCH_I_GAIN  is  used  to  compute  the  attitude  control  pitch 
integrator  by  a  call  to  the  CSU  set_pitch_attitude.  The  integrator  is  used  to 
compute  the  attitude  control  pitch  command. 

attitude_control_pitch_integrator  += 

ATT_CTL_PITCH_LGAIN  (pitch  -  angle); 
attitude_control_pitch_integrator  = 

limiter  (-0.1,  attitude_control_pitchJntegrator,  0.1); 
attitude_control_pitch_command  =  ATT_CTL_PITCH_P_GAIN  * 

(pitch  -  angle); 

attitude_control_pitch_command  +=  attitude_control_pitch_integrator; 
attitude_control_pitch_command  =  limiter  ( 

-MAX_STAB_AUG_PITCH_ROLL_CONTROL, 
attitude_control_pitch_command, 
MAX_STAB_AUG_PITCH_ROLL_CONTROL); 
return  (attitude_control_pitch_command); 

_ 

See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.56  ATT_CTL_ROLL_P_GAIN 

ATT_CTL_ROLL_P_GAIN  is  a  constant  defining  the  slope  for  the  attitude 
control  roll  command  equation. 
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3.1.56.1  Initialization 

The  constant  ATT_CTL_ROLL_P_GAIN  is  initialized  during  execution  of 
the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  ATT_CTL_ROLL_P_GAIN  aero_data[55] 


3.1.56.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.56.2.1  Algorithm 

A,TT_CTL_ROLL_P_GAIN  is  used  to  compute  the  attitude  control  roll 
command  by  a  call  to  the  CSU  set_roll_attitude. 


attitude_control_roll_integrator  +=  ATT_CTL_ROLL_I_GAIN  * 

(roll  -  angle); 

/****  These  used  to  be  attitude_control_pitch_integrator  instead  of 
attitude_control_roll_integrator.  PJM  11-1-89 
attitude_control_pitch_integrator  = 

limiter  (-0.1,  attitude_control_pitch_integrator,  0.1); 

j 

attitude_control_roll_integrator  = 

limiter  (-0.1,  attitude_control_roll_integrator,  0.1); 
attitude_control_roil_command  =  ATT_CTL_ROLL_P_GAIN  * 

(roll  -  angle); 

attitude_control_roll_command  -i-=  attitude_control_roll_integrator; 
attitude_control_roll_command  =  limiter  ( 

-MAX_STAB_AUG_PITCH_ROLL_CONTROL, 
attitude_control_roll_command, 
MAX_STAB_AUG_PITCH_ROLL_CONTROL); 
return  (attitude_control_roll_command); 


See  APPENDIX  B  for  a  complete  source  code  listing. 
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3.1.57  ATT_CTL_ROLL_I_GAIN 

ATT_CTL_ROLL_I_GAIN  is  a  constant  defining  the  slope  for  the  attitude 
control  roll  integrator  equation. 

3.1.57.1  Initialization 

The  constant  ATT_CTL_ROLL_I_GAIN  is  initialized  during  execution  of  the 
CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  ATT_CTL_ROLL_I_GAIN  aero_data[56] 


3.1.57.2  Usage 

t 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.57.2.1  Algorithm 

ATT_CTL_ROLL_I_GAIN  is  used  to  compute  the  attitude  control  roll 
integrator  by  a  call  to  the  CSU  set_roll_attitude.  The  integrator  is  used  to 
compute  the  attitude  control  roll  command. 


attitude_control_roll_integrator  +=  ATT_CTL_ROLL_I_GAIN  * 

(roll  -  angle); 

/****  These  used  to  be  attitude_control_pitch_integrator  instead  of 
attitude_control_roll_integrator.  PJM  11-1-89 
attitude_control_pitch_integrator  = 

limiter  (-0.1,  attitude_control_pitch_integrator,  0.1); 

attitude_control_roll_integrator  = 

limiter  (-0.1,  attitude_control_roll_integrator,  0.1); 
attitude_control_roll_command  =  ATT_CTL_ROLL_P_GAIN  * 

(roll  -  angle); 

attitude_control_roll_command  +=  attitude_control_roll_integrator; 
attitude_control_roll_command  =  limiter  ( 

-MAX_STAB_AUG_PITCH_ROLL_CONTROL, 
attitude_control_roll_command, 
MAX_STAB_AUG_PITCH_ROLL_CONTROL); 
return  (attitude_control_roll_command); 
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See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.58  HOVER_AUG_ROLL_P_GAIN 

HOVER_AUG_ROLL_P_GAIN  is  a  constant  defining  the  slope  for  the  hover 
augmentation  roll  angle  equation. 

3.1.58.1  Initialization 

The  constant  HOVER_AUG_ROLL_P_GAIN  is  initialized  during  execution 
of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 

#define  HOVER_AUG_ROLL_P_GAIN  aero_data[57] 


3.1.58.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.58.2.1  Algorithm 

HOVER_AUG_ROLL_P_GAIN  is  used  to  compute  the  hover  augmentation 
roll  angle  by  a  call  to  the  CSU  compute_stab_augmentation_gains. 


if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

hover_hold_turned_on  =  TRUE  ; 

I*  You  should  already  be  "hovering"  (airspeed  <  10  knots) 
for  hover  hold  to  show  little  visible  swaying.  */ 

hover_aug_roll_integrator  =  0.0  ; 

} 

hover_aug_roll_integrator  += 

HOVER_AUG_ROLL_I_GAIN  velocity_vector[X]; 
hover_aug_roll_integrator  = 

_ limiter(-0.2,hover_aug_roll_integrator,0.2); _ 
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hover_aug_roll_angle  =  HOVER_AUG_ROLL_P_GAIN 

velocity  _vector[X] 

+  hover_aug_roll_mtegrator; 

hover_aug_roll_angle  =  limiter  (-MAX_ATT_CTL_ ANGLE, 

hover_aug_roll_angle, 
MAX_ATT_CTL_  ANGLE); 

stab_aug_roll  =  set_roll_attitude  (hover_aug_roll_angle); 

”} 

else 

{ 

stab_aug_roll  =  0.0; 

#ifdef  notdef 

hover_aug_roll_integrator  =  0.0;  /*  added  8/31/89  (jwc)  */ 

hover_aug_pitch_integrator  =  0.0; 

#endif 

} 

controller_cyclic_roll  =  cyclic_roll  +  stab_aug_roll; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.59  HOVER_AUG_ROLL_I_GAIN 

HOVER_AUG_ROLL_I_GAIN  is  a  constant  defining  the  slope  for  the  hover 
augmentation  roll  integrator  equation. 

3.1.59.1  Initialization 

The  constant  HOVER_AUG_ROLL_I_GAIN  is  initialized  during  execution 
of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 

#define  HOVER_AUG_ROLL_I_GAIN  aero_data[58] 

3.1.59.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 
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3.1.59.2.1  Algorithm 

HOVER_AUG_ROLL_I_GAIN  is  used  to  compute  the  hover  augmentation 
roll  integrator  by  a  call  to  the  CSU  compute_stab_augmentation_gains.  The 
integrator  is  used  to  compute  the  hover  augmentation  roll  angle. 

if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

hover_hold_turned_on  =  TRUE  ; 

I*  You  should  already  be  "hovering"  (airspeed  <10  knots) 
for  hover  hold  to  show  little  visible  swaying.  *! 

hover_aug_roll_integrator  =  0.0  ; 

} 

hover_aug_roll_integrator  += 

HOVER_AUG_ROLL_I_GAIN  *  velocity_vector[X]; 
hover_aug_roll_integrator  = 

limiter(-0.2,hover_aug_roll_integrator,0.2); 
hover_aug_roll_angle  =  HOVER_AUG_ROLL_P_GAIN 

velocity_vector[X] 

+  hover_aug_roll_integrator; 

hover_aug_roll_angle  =  limiter  (-MAX_ATT_CTL_ANGLE, 

hover_aug_roll_angle, 

MAX_ATT_CTL_  ANGLE); 

stab_aug_roll  =  set_roll_attitude  (hover_aug_roll_angle); 

.... 

else 

{ 

stab_aug_roll  =  0.0; 

#ifdef  notdef 

hover_aug_roll_integrator  =  0.0;  added  8/31/89  (jwc)  */ 

hover_aug_pitch_integrator  =  0.0; 

#endif 

} 

controller_cyclic_roll  =  cyclic_roll  +  stab_aug_roll; 
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See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.60  HOVER_AUG_PITCH_P_GAIN 

HOVER_AUG_PITCH_P_GAIN  is  a  constant  defining  the  slope  for  the 
hover  augmentation  pitch  angle  equation. 

3.1.60.1  Initialization 

The  constant  HOVER_AUG_PITCH_P_GAIN  is  initialized  during  execution 
of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 

#define  HOVER_AUG_PITCH_P_GAIN  aero_data[59] 


3.1.60.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.60.2.1  Algorithm 

HOVER_AUG_PITCH_P_GAJN  is  used  to  compute  the  hover  augmentation 
pitch  angle  by  a  call  to  the  CSU  compute_stab_augmentation_gains. 


if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

hover_aug_pitch_integrator  = 

H0VER_AUG_PITCH_RESET_VALUE  ; 

} 


hover_aug_pitch_integrator  += 

HOVER_AUG_PITCH_I_GAIN  velocity, vectorfY]; 

hover_aug_pitch_integrator  = 

limiter(-0.2,hover_aug_pitchjntegrator,0.2); 
hover_aug_pitch_angle  =  HOVER_AUG_PITCH_P_GAIN  * 
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veloci  ty_vector  [  Y  ] 

+  hover_aug_pitch_integrator; 

hover_aug_pitch_angle  =  limiter  (-MAX_ATT_CTL_ANGLE, 

hover_aug_pitch_angle, 
MAX_ATT_CTL_  ANGLE); 

stab_aug_pitch  =  set_pitch_attitude  (hover_aug_pitch_angle); 


else 


stab_aug_pitch  =  0.0; 

#ifdef  notdef 

hover_aug_roll_integrator  =  0.0;  /*  added  8/31/89  (jwc)  */ 

hover_aug_pitch_integrator  =  0.0; 

#endif 

} 

f 

controller_cyclic_pitch  =  cyclic_pitch  +  stab_aug_pitch; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.61  HOVER_AUG_PITCH_I_GAIN 

HOVER_AUG_PITCH_I_GAIN  is  a  constant  defining  the  slope  for  the  hover 
augmentation  pitch  integrator  equation. 

3.1.61.1  Initialization 

The  constant  HOVER_AUG_PITCH_I_GAIN  is  initialized  during  execution 
of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  HOVER_AUG_PITCH_I_GAIN  aero_data[60] 


3.1.61.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 
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3.1.61.2.1  Algorithm 

HOVER_AUG_PITCH_I_GAIN  is  used  to  compute  the  hover  augmentation 
pitch  integrator  by  a  call  to  the  CSU  compute_stab_augmentation_gains.  The 
integrator  is  used  to  compute  the  hover  augmentation  pitch  angle. 


if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

hover_aug_pitch_integrator  = 

HOVER_AUG_PITCH_RESET_VALUE  ; 

} 

hover_aug_pitch_integrator  += 

.  HOVER_AUG_PITCH_I_GAIN  velocity _ vector [Y]; 

hover_aug_pitch_integrator  = 

limiter(-0.2,hover_aug_pitch_integrator,0.2); 
hover_aug_pitch_angle  =  HOVER_AUG_PITCH_P_GAIN 
velocity  _vector[Y] 

+  hover_aug_pitch_integrator; 
hover_aug_pitch_angle  =  limiter  (-MAX_ATT_CTL_ANGLE, 

hover_aug_pitch_angle, 

MAX_ATT_CTL_ANGLE); 

stab_aug_pitch  =  set_pitch_attitude  (hover_aug_pitch_angle); 


} 

else 

{ 

stab_aug_pitch  =  0.0; 

#ifdef  notdef 

hover_aug_roll_integrator  =  0.0;  added  8/31/89  (jwc) 

hover_aug_pitch_integrator  =  0.0; 

#endif 

} 

controller_cyclic_pitch  =  cyclic_pitch  +  stab_aug_pitch; 
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See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.62  HOVER_AUG_YAW_P_GAIN 

HOVER_AUG_YAW_P_GAIN  is  a  constant  defining  the  slope  for  the  hover 
augmentation  yaw  angle  equation. 

3.1.62.1  Initialization 

The  constant  HOVER_AUG_YAW_P_GAIN  is  initialized  during  execution 
of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodyn_init  is  normally  done'  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  HOVER_AUG_YAW_P_GAIN  aero_data[61] 


3.1.62.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.62.2.1  Algorithm 

HOVER_AUG_YAW_P_GAIN  is  used  to  compute  the  hover  augmentation 
yaw  angle  by  a  call  to  the  CSU  compute_stab_augmentation_gains. 


if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

stab_aug_yaw_integrator  =  0.0  ; 

} 

stab_aug_yaw_integrator  -= 

HOVER_AUG_YAW_I_GAIN 

angular_velocity_vector[Z]; 

if  (stab_aug_yaw_integrator  >  0.5)  stab_aug_yaw_integrator  =  0.5; 
if  (stab_aug_yaw_integrator  <  -0.5)  stab_aug_yaw_integrator  =  -0.5; 
stab_aug_yaw  =  -  HOVER_AUG_YAW_P_GAIN  * 
angular_velocity_vector[Z]  + 
stab_aug_yaw_integrator; 
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} 

gIsg 

{ 

stab_aug_yaw  =  0.0; 

.... 

controllGr_tail_rotor  =  pGdal  +  stab_aug_yaw; 


Sgg  appendix  B  for  a  complGtG  sourcG  codG  listirxg. 

3.1.63  HOVER_AUG_YAW_I_GAIN 

HOVER_AUG_YAW_I_GAIN  is  a  constant  dofining  tho  slopG  for  thG  hovGr 
augmGntation  yaw  intGgrator  Gquation. 

3.1.63.1  Initialization 

ThG  constant  HOVER_AUG_YAW_I_GAIN  is  initializGd  during  GXGCution 
of  thG  CSU  aGrodynJnit,  calkd  by  CSC  rwajnit.  ExGCution  of  thG  CSU 
aGrodyn_init  is  normally  donG  only  oncG  during  CSCI  initialization  and  is 
pcrformod  soqucntially.  Sgg  TABLE  5.1.1.  -  AGrodynamics  Data  Array  for  a 
summary  of  thG  constant. 


#dGfinG  HOVER_AUG_YAW_I_GAIN  aGro_data[62] 


3.1.63.2  Usage 

During  rGal-timo  GXGCUtion,  this  variablG  is  not  rocomputod. 

3.1.63.2.1  Algorithm 

HOVER_AUG_YAW_I_GAIN  is  usGd  to  computG  thG  hover  augmentation 
yaw  integrator  by  a  call  to  the  CSU  compute_stab_augmentation_gains.  The 
integrator  is  used  to  compute  the  hover  augmentation  yaw  angle. 


if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 
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3.1.64.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.64.2.1  Algorithm 

HOVER_AUG_CLIMB_P_GAIN  is  used  to  compute  the  hover 
augmentation  climb  angle  by  a  call  to  the  CSU 
compute_stab_augmentation_gains. 


if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

stab_aug_climb_integrator  =  0.0  ; 


stab_aug_climb_integrator  -= 

HOVER_AUG_CLIMBJ_GAIN  velocity_vector[Z]; 
if  (stab_aug_climb_integrator  >  0.2)  stab_aug_climb_integrator  =  0.2; 
if  (stab_aug_climb_integrator  <  -0.2)  stab_aug_climb_integrator  =  -0.2; 
stab_aug_climb  =  -  HOVER. AUG_CLIMB_P_GAIN  * 

velocity_vector[Z]  +  stab_aug_climb_integrator; 

stab_aug_yaw  =  limiter  ( 

-MAX_STAB_AUG_YAW_CLIMB_CONTROL, 

stab_aug_yaw, 

MAX_STAB_AUG_YAW_CLIMB_CONTROL); 

stab_aug_climb  =  limiter  ( 

-MAX_STAB_AUG_YAW_CLIMB_CONTROL, 
s  tab_aug_climb, 

MAX_STAB_AUG_YAW_CLIMB_CONTROL); 
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else 

{ 

stab_aug_climb  =  0.0; 

'T 

controller_collective  =  collective  +  stab_aug_climb; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.65  HOVER_AUG_CLIMB_I_GAIN 

HOVER_AUG_CLIMB_I_GAIN  is  a  constant  defining  the  slope  for  the 
hover  augmentation  climb  integrator  equation. 

3.1.65.1  Initialization 

The  constant  HOVER_AUG_CLIMB_I_GAIN  is  initialized  during  execution 
of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodyn_mit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  HOVER_AUG_CLIMB_I_GAIN  aero_data[64] 


3.1.65.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.65.2.1  Algorithm 

HOVER_AUG_CLIMB_I_GAIN  is  used  to  compute  the  hover  augmentation 
climb  integrator  by  a  call  to  the  CSU  compute_stab_augmentation_gains. 
The  integrator  is  used  to  compute  the  hover  augmentation  climb  angle. 
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if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

stab_aug_climb_integrator  =  0.0  ; 

} 

stab_aug_climb_integrator  -= 

HOVER_AUG_CLIMBJ_GAIN  veIocity_vector[Z]; 
if  (stab_aug_climb_integrator  >  0.2)  stab_aug_cliinb_integrator  =  0.2; 
if  (stab_aug_clinrib_integrator  <  -0.2)  stab_aug_climb_integrator  =  -0.2; 
stab_aug_climb  =  -  HOVER_AUG_CLIMB_P_GAIN 

velocity  _vector[Z]  +  stab_aug_climb_integrator; 

stab_aug_yaw  =  limiter  ( 

-MAX_STAB_AUG_YAW_CLIMB_CONTROL, 

stab_aug_yaw, 

MAX_STAB_AUG_YAW_CLIMB_CONTROL); 

stab_aug_climb  =  limiter  ( 

-MAX_STAB_AUG_YAW_CLIMB_CONTROL, 

stab_aug_climb, 

MAX_STAB_AUG_YAW_CLIMB_CONTROL); 

} 

else 

{ 

stab_aug_climb  =  0.0; 

}’ 

controller_collective  =  collective  +  stab_aug_climb; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.66  MAX_STAB_AUG_PITCH_ROLL_CONTROL 

MAX_STAB_AUG_PITCH_ROLL_CONTROL  is  a  constant  defining  the 
upper  and  lower  limits  of  the  attitude  control  roll  command  and  attitude 
control  pitch  command  for  cross  coupling  effects. 
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3.1.66.1  Initialization 

The  constant  MAX_STAB_AUG_PITCH_ROLL_CONTROL  is  initialized 
during  execution  of  the  CSU  aerodyn_init,  called  by  CSC  rwajnit.  Execution 
of  the  CSU  aerodynjnit  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.1.  - 
Aerodynamics  Data  Array  for  a  summary  of  the  constant. 


#define  MAX_STAB_AUG_PITCH_ROLL_CONTROL  aero_data[65] 


3.1.66.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.66.2.1  Algorithm 

MAX_STAB_AUG_PITCH_ROLL_CONTROL  is  used  to  compute  the  upper 
and  lower  limits  of  the  attitude  control  roll  command  by  a  call  to  the  CSU 
set_roll_attitude. 


attitude_control_roll_integrator  +=  ATT_CTL_ROLL_I_GAIN  * 

(roll  -  angle); 

/****  These  used  to  be  attitude_control_pitch_integrator  instead  of 
attitude_control_roll_integrator.  PJM  11-1-89 
attitude_control_pitch_integrator  = 

limiter  (-0.1,  attitude_control_pitch_integrator,  0.1); 

attitude_control_roll_integrator  = 

limiter  (-0.1,  attitude_control_roll_integrator,  0.1); 
attitude_control_roll_command  =  ATT_CTL_ROLL_P_GAIN 
(roll  -  angle); 

attitude_control_roll_command  +=  attitude_control_roll_integrator; 
attitude_control_roll_command  =  limiter  ( 

-MAX_STAB_AUG_PITCH_ROLL_CONTROL, 
attitude_control_roll_command, 
MAX_STAB_AUG_PITCH_ROLL_CONTROL); 
return  (attitude_control_roll_command); 


MAX_STAB_AUG_PITCH_ROLL_CONTROL  is  used  to  compute  the  upper 
and  lower  limits  of  the  attitude  control  pitch  command  by  a  call  to  the  CSU 
set_pitch_attitude. 
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attitude_control_pitch_integrator  += 

ATT_CTL_PITCHJ_GAIN  (pitch  -  angle); 
attitude_control_pitch_integrator  = 

limiter  (-0.1,  attitude_control_pitch_integrator,  0.1); 
attitude_control_pitch_command  =  ATT_CTL_PITCH_P_GAIN 
(pitch  -  angle); 

attitude_control_pitch_command  +=  attitude_control_pitch_integrator; 
attitude_control_pitch_command  =  limiter  ( 

-MAX_STAB_AUG_PITCH_ROLL_CONTROL, 
attitude_control_pitch_command, 
MAX_STAB_AUG_PITCH_ROLL_CONTROL); 
return  (attitude_control_pitch_command); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.67  MAX_STAB_AUG_YAW_CLIMB_CONTROL 

I 

MAX_STAB_AUG_YAW_CLIMB_CONTROL  is  a  constant  defining  the 
upper  and  lower  limits  of  the  stabilator  augmentation  yaw  command  and 
stabilator  augmentation  climb  command  for  cross  coupling  effects. 

3.1.67.1  Initialization 

The  constant  MAX_STAB_AUG_YAW_CLIMB_CONTROL  is  initialized 
during  execution  of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution 
of  the  CSU  aerodyn_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.1.  - 
Aerodynamics  Data  Array  for  a  summary  of  the  constant. 


#define  MAX_STAB_AUG_YAW_CLIMB_CONTROL  aero_data[66] 


3.1.67.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.67.2.1  Algorithm 

MAX_STAB_AUG_YAW_CLIMB_CONTROL  is  used  to  compute  the  upper 
and  lower  limits  of  the  stabilator  augmentation  yaw  command  and  stabilator 
augmentation  climb  command  by  a  call  to  the  CSU 
compute_stab_augmentation_gains. 
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if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

stab_aug_climb_integrator  =  0.0  ; 

} 

stab_aug_climb_integrator  -= 

HOVER_AUG_CLIMB_I_GAIN  velocity_vector[Z]; 
if  (stab_aug_climb_integrator  >  0.2)  stab_aug_climb_integrator  =  0.2; 
if  (stab_aug_climb_integrator  <  -0.2)  stab_aug_climb_integrator  =  -0.2; 
stab_aug_climb  =  -  HOVER_AUG_CLIMB_P_GAIN  * 

velocity  _vector[Z]  +  stab_aug_climb_integrator; 

stab_aug_yaw  =  limiter  ( 

-MAX_STAB_AUG_YAW_CLIMB_CONTROL, 

'  stab_aug_yaw, 

MAX_STAB_AUG_YAW_CLIMB_CONTROL); 

stab_aug_climb  =  limiter  ( 

-MAX_STAB_AUG_YAW_CLIMB_CONTROL, 

stab_aug_climb, 

MAX_STAB_AUG_YAW_CLIMB_CONTROL); 

} 

else 

{ 

stab_aug_climb  =  0.0; 

}’ 

controller_collective  =  collective  +  stab_aug_climb; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.68  ROLL_RATE_DAMPING_GAIN 

ROLL_RATE_D AMPIN G_G AIN  is  a  constant  defining  the  roll  damping  rate. 
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3.1.68.1  Initialization 

The  constant  ROLL_RATE_DAMPING_GAIN  is  initialized  during  execution 
of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  ROLL_RATE_DAMPING_GAIN  aero_data[67] 


3.1.68.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.68.2.1  Algorithm 

ROLL_RATE_DAMPING_GAIN  is  used  to  initialize  the  roll  damping  by  a 
call  to  the  CSU  aerodynjnit. 


rolLdamping  =  ROLL_RATE_DAMPING_GAIN; 


The  roll  damping  is  increased  if  hover  hold  is  turned  on  by  a  call  to  the  CSU 
compute_stab_augmentation_gains. 


if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

hover_hold_turned_on  =  TRUE  ; 
roll_damping  ■=  2  *  ROLL_RATE_DAMPING_GAIN; 
} 

T  _ 
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else 

{ 

roll_damping  =  ROLL_RATE_DAMPING_GAIN; 

}' 


The  rolLdamping  is  used  to  compute  the  y-axis  element  of  damping  of  the 
body  moment  vector  by  a  call  to  the  CSU 

compute_body_damping_forces_and_moments. 


moment_body_damping[Y]  =  -  roll_damping  *  roll_rate; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.69  PITCH_RATE_DAMPING_GAIN 

I 

PITCH_RATE_DAMPING_GAIN  is  a  constant  defining  the  pitch  damping 
rate. 

3.1.69.1  Initialization 

The  constant  PITCH_RATE_DAMPING_GAIN  is  initialized  during 
execution  of  the  CSU  aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the 
CSU  aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  PITCH_RATE_DAMPING_GAIN  aero_data[68] 


3.1.69.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.69.2.1  Algorithm 

PITCH_RATE_DAMPING_GAIN  is  used  to  initialize  the  pitch  damping  by  a 
call  to  the  CSU  aerodynjnit. 
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pitch_damping  =  PITCH_RATE_DAMPING_GAIN; 


The  pitch  damping  is  increased  if  hover  hold  is  turned  on  by  a  call  to  the  CSU 
compute_stab_augmentation_gains. 


if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

pitch_damping  =  2  *  PITCH_RATE_DAMPING_GAIN; 
/=^jwc8/90  V 

} 

y 

'else 

{ 

pitch.damping  =  PITCH_RATE_DAMPING_GAIN;  /*  jwc  8/90  V 

.... 


The  pitch.damping  is  used  to  compute  the  x-axis  element  of  damping  of  the 
body  moment  vector  by  a  call  to  the  CSU 
compute.body.damping.forces.and.moments. 


moment_body_damping[X]  =  -  pitch.damping  pitch.rate; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.70  YAW.RATE.DAMPING.GAIN 

YAW.RATE.DAMPING.GAIN  is  a  constant  defining  the  yaw  damping 
rate. 

3.1.70.1  Initialization 

The  constant  YAW.RATE.DAMPING.GAIN  is  initialized  during  execution 
of  the  CSU  aerodyn.init,  called  by  CSC  rwa.init.  Execution  of  the  CSU 
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aerodyn_mit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  YAW_RATE_DAMPING_GAIN  aero_data[69] 


3.1.70.2  Usage 

During  real-time  execution,  this,  variable  is  not  recomputed. 

3.1.70.2.1  Algorithm 

YAW_RATE_DAMPING_GAIN  is  used  to  initialize  the  yaw  damping  by  a 
call  to  the  CSU  aerodynjnit. 


yaw_damping  =  YAW_RATE_DAMPING_GAIN; 

I 

The  yaw_damping  is  used  to  compute  the  z-axis  element  of  damping  of  the 
body  moment  vector  by  a  call  to  the  CSU 
compute_body_damping_forces_and_moments. 


moment_body_damping[Z]  =  -  yaw_damping  *  yaw_rate; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.71  VERTICAL_RATE_DAMPING_GAIN 

VERTICAL_RATE_DAMPING_GAIN  is  a  constant  defining  the  vertical 
damping  rate. 

3.1.71.1  Initialization 

The  constant  VERTICAL_RATE_DAMPING_GAIN  is  initialized  during 
execution  of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the 
CSU  aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 
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#define  VERTICAL_RATE_DAMPING_GAIN  aero_data[70] 


3.1.71.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.71.2.1  Algorithm 

VERTICAL_RATE_DAMPING_GAIN  is  used  to  compute  the  z-axis  element 
of  damping  on  the  body  force  by  a  call  to  the  CSU 
compute_body_damping_forces_and_moments. 


force_body_damping[Z]  =  -velocity _vector[Z]  * 

VERTICAL_RATE_DAMPING_GAIN; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.72  LATERAL_VELOCITY_DAMPING_GAIN 

LATERAL_VELOCITY_DAMPING_GAIN  is  a  constant  defining  the  lateral 
velocity  damping  rate. 

3.1.72.1  Initialization 

The  constant  LATERAL_VELOCITY_DAMPING_GAIN  is  initialized  during 
execution  of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the 
CSU  aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  LATERAL_VELOCITY_DAMPING_GAIN  aero_data[71] 


3.1.72.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.72.2.1  Algorithm 

LATERAL_VELOCITY_DAMPING_GAIN  is  used  to  compute  the  x-axis 
element  of  damping  on  the  body  force  by  a  call  to  the  CSU 
compute_body_damping_forces_and_moments. 
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force_body_damping[X]'  =  -velocity _vector[X]  * 

LATERAL_VELOCITY_DAMPING_GAIN; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.73  LIFT_COEFF_VIRTUAL_WING 

LIFT_COEFF_VIRTUAL_WING  is  a  constant  defining  the  lift  coefficient  of 
the  virtual  wing. 

3.1.73.1  Initialization 

The  constant  LIFT_COEFF_VIRTUAL_WING  is  initialized  during  execution 
of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
supamary  of  the  constant. 

#define  LIFT_COEFF_ VIRTU AL_WING  aero_data[72] 

3.1.73.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.73.2.1  Algorithm 

LIFT_COEFF_VIRTUAL_WING  is  used  to  initialize  the  lift  coefficient  of  the 
virtual  wing  by  a  call  to  the  CSU  compute_lift_drag_coefficients. 

lift_coefficient_virtual_wing  =  LIFT_COEFF_VIRTUAL_WING; 

The  lift_coefficient_virtual_wing  is  used  to  compute  the  lift  force  on  the 
virtual  wing  by  a  call  to  the  CSU  compute_lift_drag_forces. 

lift_coefficient_virtual_wing  VIRTUAL_WING_AREA; 


See  APPENDIX  B  for  a  complete  source  code  listing. 
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3.1.74  OSWALD_EFFIC_FACTOR 

OSWALD_EFFIC_F ACTOR  is  a  constant  defining  the  Oswald  efficiency  factor. 
3.1.74.1  Initialization 

The  constant  OSWALD_EFFIC_FACTOR  is  initialized  during  execution  of 
the  CSU  aerodyn_init,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 

#define  OSWALD_EFFIC_FACTOR  aero_data[73] 


3.1.74.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.74.2.1  Algorithm 

OSWALD_EFFIC_F ACTOR  is  used  to  initialize  the  Oswald  efficiency  factor  by 
a  call  to  the  CSU  compute_lift_drag_coefficients. 

oswald_efficiency_factor  =  OSWALD_EFFIC_FACTOR; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.1.75  INDUCED_DRAG_COEFF 

INDUCED_DRAG_COEFF  is  a  constant  defining  the  induced  drag  coefficient. 
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3.1.75.1  Initialization 

The  constant  INDUCED_DRAG_COEFF  is  initialized  during  execution  of  the 
CSU  aerodyn_iniL  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.1.  -  Aerodynamics  Data  Array  for  a 
summary  of  the  constant. 


#define  INDUCED_DRAG_COEFF  aero_data[74] 

3.1.75.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.1.75.2.1  Algorithm 

INDUCED_DRAG_COEFF  is  used  to  initialize  the  induced  drag  coefficient  by 
a  call  to  the  CSU  compute_lift_drag_coefficients. 


induced_drag_coefficient  =  INDUCED_DRAG_COEFF; 


The  induced_drag_coefficient  is  used  to  compute  the  total  incompressible 
drag  by  a  call  to  the  CSU  compute_lift_drag_coefficients. 


total_incompressible_drag_coefficient  =  parasite_drag_coefficient  + 

induced_drag_coefficient; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.2  Aero_init 

This  data  array  consists  of  initial  values  for  positions  of  the  control  inputs, 
stabilator  augmentation  integrators,  attitude  control  integrators,  and  hover 
augmentation  integrators. 

3.2.1  Cyclic_pitch 

Cyclic_pitch  is  a  variable  defining  the  longitudinal  position  of  the  cyclic. 
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3.2.1.1  Initialization 

The  variable  cyclic_pitch  is  initialized  during  execution  of  the  CSU 
aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.2.  -  Aerodynamics  Initialization  Data  Array  for  a 
summary  of  the  variable. 


cyclic_pitch  = 


aero_init[  0]; 


3.2.1.2  Usage 

During  real-time  execution,  this  variable  is  recomputed.  The  normal  range  is 
from  -1.0  to  +1.0. 

3.2.1.2.1  Algorithm 

Cyclic_pitch  is  used  to  compute  the  cyclic  controller  pitch  input.  The 
longitudinal  position  of  the  cyclic  is  set  by  a  call  to  the  CSU 
aerodyn_set_longitudinal_stick  to  read  the  physical  position. 


void  aerodyn_set_longitudinal_stick  (val) 
REAL  val; 

{ 

cyclic_pitch  =  -val; 

} 


The  controller_cyclic_pitch  is  used  to  compute  the  pitching  moment  of  the 
moment_body_main_rotor  vector  during  execution  of  CSU 
compute_rotor_forces_and_moments. 


moment_body_main_rotor[X]  = 

-  controller_cyclic_pitch  * 
MAIN_ROTOR_MAX_PITCH_MOMENT; 


The  cyclic_pitch  is  used  to  compute  the  controller_cyclic_pitch  in  the  CSC 
compute_stab_augmentation_gains. 
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controller  _cyclic_pitch  =  cyclic_pitch  +  stab_aug_pitch; 


During  execution  of  the  simple  flight  model,  the  cyclic_pitch  is  used  to 
compute  the  liftjactor  in  the  CSC  aerodyn_simple_simul. 


lift_factor  =  velocity_vector[l]  ^  velocity_vector[l]  *  H_CL 
-  cyclic_pitch; 


During  execution  of  the  simple  flight  model,  the  cyclic_pitch  is  used  to 
compute  the  pitch  element  of  the  desired  orientation  vector  and  the  torque 
required  in  the  CSC  aerodyn_simple_simul. 


orient_vec[0]  =  H_KPR  *  -  cyclic_pitch  +  hover_hold_additions[0]; 

I 

During  execution  of  the  stealth  flight  model,  the  cyclic.pitch  is  used  to 
compute  the  desired  rotation  vector  and  the  desired  linear  velocity  vector  in 
the  CSC  aerodyn_stealth_simul. 
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if  (hover_hold_state  ==  ON) 

{  /*  no  linear  velocity  in  X,Y,  only  pitch  */ 

desiredJin_vel[X]  =  desired_lin_vel[Y]  =  0.0; 

desired_rot_vel[X]  =  -cyclic_pitch  cyclic_pitch  sign(cyclic_pitch), 
desired_rot_vel[Y]  =  0.0; 

} 

else 

if  (level_view)/*  when  not  in  pitch  mode,  level  view  */ 

{  .  , 

vehicle_set_orientation_matrix  (level);  /*  identity  matrix  */ 

vehicle_set_orientation  (kinematics_get_heading()); 

level_view  =  FALSE; 

} 

desiredJin_vel[X]  =  cyclic_roil  cyclic_roll  sign  (cyclic_roll) 
H_SIDE_MUL; 

desired_lin_vel[Y]  =  cyclic_pitch  *  cyclic_pitch  sign  (cyclic_pitch) 
H_FWD_MUL; 

I 

desired_rot_vel[X]  =  desired_rot_vel[Y]  =  0.0; 

} 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.2.2  Cyclic_roll 

Cyclic_roll  is  a  variable  defining  the  lateral  position  of  the  cyclic. 

3.2.2.1  Initialization 

The  variable  cyclic_roll  is  initialized  during  execution  of  the  CSU 
aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.2.  -  Aerodynamics  Initialization  Data  Array  for  a 
summary  of  the  variable. 


cyclic_roll  =  aeroJnit[  1]; 


3.2.2.2  Usage 

During  real-time  execution,  this  variable  is  recomputed.  The  normal  range  is 
from  -1.0  to  +1.0. 
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3.2.2.2.1  Algorithm 

Cyclic_roll  is  used  to  compute  the  cyclic  controller  roll  input.  The  lateral 
position  of  the  cyclic  is  set  by  a  call  to  the  CSU  aerodyn_set_lateral_stick  to 
read  the  physical  position. 


[void  aerodyn_set_lateral_stick  (val) 
REAL  val; 

|{ 

cyclic_roll  =  -val; 


The  controller_cyclic_roll  is  used  to  compute  the  rolling  moment  of  the 
moment_body_main_rotor  vector  during  execution  of  CSU 
compute_rotor_forces_and_moments. 


'  moment_body_main_rotor[Y]  = 

controller_cyclic_roll  * 
MAIN_ROTOR_MAX_ROLL_MOMENT; 


The  cyclic_roll  is  used  to  compute  the  controller_cyclic_roll  in  the  CSC 
compute_stab_augmentation_gains. 


During  execution  of  the  simple  flight  model,  the  cyclic_roll  is  used  to 
compute  the  roll  element  of  the  desired  orientation  vector  and  the  torque 
required  in  the  CSC  aerodyn_simple_simul. 


orient_vec[l]  =  H_KPR  cyclic_roll  +  hover_hold_additions[l]; 


During  execution  of  the  stealth  flight  model,  the  cyclic_roll.  is  used  to 
compute  the  desired  rotation  vector  and  the  desired  linear  velocity  vector  in 
the  CSC  aerodyn_stealth_simul. 
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if  (hover_hold_state  ==  ON) 

{  /*  no  linear  velocity  in  X,Y,  only  pitch  * / 

desired_lin_vel[X]  =  desired_lin_vel[Y]  =  0.0; 
desired_rot_vel[X]  =  -cyclic_pitch  *  cyclic_pitch  *  sign(cyclic_pitch); 
desired_rot_vel[Y]  =  0.0; 

} 

else 

{ 

if  (level_view)/*  when  not  in  pitch  mode,  level  view  */ 

{ 

vehicle_set_orientation_matrix  (level);  /*  identity  matrix  */ 
vehicle_set_orientation  {kinematics_get_heading()); 
level_view  =  FALSE; 

} 

desired_lm_vel[X]  =  cyclic_roll  *  cyclic_roll  *  sign  (cyclic_roll) 
H_SIDE_MUL; 

desired_lin_vel[Y]  =  cyclic_pitch  *  cyclic_pitch  *  sign  (cyclic_pitch) 

-  *  H_FWD_MUL; 

desired_rot_vel[X]  =  desired_rot_vel[Y]  =  0.0; 

} 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.2.3  Collective 

Collective  is  a  variable  defining  the  position  of  the  collective. 

3.2.3.1  Initialization 

The  variable  collective  is  initialized  during  execution  of  the  CSU 
aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.2.  -  Aerodynamics  Initialization  Data  Array  for  a 
summary  of  the  variable. 
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3.2.3.2  Usage 


During  real-time  execution,  this  variable  is  recomputed.  The  normal  range  is 
from  0.0  to  +1.0. 

3.2.3.2.1  Algorithm 

Collective  is  used  to  compute  the  collective  controller  input.  The  collective 
position  of  the  cyclic  is  set  by  a  call  to  the  CSU  aerodyn_set_collective  to  read 
tl^e  physical  position. 

void  aerodyn_set_collective  (val) 

REAL  val; 

{ 

if  (funny _little_kludge) 

collective  =  loglO  (val  *  9.0  +  1.0);  I*  or,  how  to  make  linear  log  *! 

else 

collective  =  val; 

} 

Controller_collective  is  used  to  compute  rotor  loads  during  execution  of  the 
CSU  compute_rotor_loads. 

main_rotor_load_torque  =  controller_collective 

MAIN_ROTOR_MAX_LOAD_TORQUE; 


Controller_collective  is  used  to  compute  main_rotor_thrust  during 
execution  of  the  CSU  compute_rotor_forces_and_moments. 
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inain_rotor_thrust  =  powertrain_percent_shaft_speed 
controller  collective 


MAIN_ROTOR_MAX_THRUST; 


X- 


The  collective  is  used  to  compute  the  controller_collective  in  the  CSC 
compute_stab_augmentation_gains. 


controller_collective  =  collective  +  stab_aug_climb; 


During  execution  of  the  simple  flight  model,  collective  is  used  to  compute  a 
collective  factor,  which  in  turn  is  used  to  compute  power  in  the  CSC 
aerodyn_simple_simul. 


coll_factor  =  max(0.0,collective  -  0.3); 

'  power  =  H_KP  *  coll_f actor  +  hover_hold_additions[2]; 
power  +=  gross_weight  *  collective/ (H_IC2+collective)  1.25; 
power  =  min  (MAX_HELICOPTER_POWER,  power); 
power  =  max  (0.0,  power); 


During  execution  of  the  stealth  flight  model,  collective  is  adjusted  for  dead 
zone  and  for  -1  to  1  range. 


adj_collective  =  (collective  -  0.5)  *  2.0;  /*  change  to  -1  to  1  */ 


During  execution  of  the  stealth  flight  model,  the  adjusted  collective  input  is 
limited  during  allow_takeoff  state. 
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if  (allow_takeoff) 

{ 

if  (adj_collective  >  0.0) 

{ 

allow_takeoff  =  FALSE; 

} 

else 

{ 

adj_collective  =  0.0; 

} 


During  execution  of  the  stealth  flight  model,  the  adjusted  collective  input  is 
used  to  compute  the  vertical  component  of  the  desired  linear  velocity  vector. 


desired_lin_vel[Z]  =  adj_collective  *  adj_collective  * 
sign  (adj_collective  )  *  H_COLL_MUL; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.2.4  Pedal 

Pedal  is  a  variable  defining  the  position  of  the  pedals  (yaw  control). 

3.2.4.1  Initialization 

The  variable  pedal  is  initialized  during  execution  of  the  CSU  aerodyn_init, 
called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is  normally  done 
only  once  during  CSCI  initialization  and  is  performed  sequentially.  See 
TABLE  5.1.2.  -  Aerodynamics  Initialization  Data  Array  for  a  summary  of  the 
variable. 


pedal  =  aero_init[  3]; 


3.2.4.2  Usage 

During  real-time  execution,  this  variable  is  recomputed.  The  normal  range  is 
from  -1.0  to  +1.0. 
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3.2.4.2.1  Algorithm 

Pedal  is  used  to  compute  the  tail  rotor  controller  input.  The  position  of  the 
pedals  is  set  by  a  call  to  the  CSU  aerodyn_set_pedal  to  read  the  physical 
position. 


void  aerodyn_set_pedal  (val) 
REAL  val; 

{ 

pedal  =  val; 

} 


The  pedal  is  used  to  compute  the  controller_tail_rotor  in  the  CSC 
compute_stab_augmentation_gains. 


I  con tr oiler _tail_ro tor  =  pedal  +  stab_aug_yaw; 


During  execution  of  the  simple  flight  model,  the  pedal  is  used  to  compute  the 
yaw  element  of  the  desired  orientation  vector  in  the  CSC 
aerodyn_simple_simul. 


orient_vec[2]  =  kinematics_get_yaw  ()  +  sign(pedal)  *  pedal 
pedal  H_KY; 


During  execution  of  the  stealth  flight  model,  the  pedal  is  used  to  compute 
vertical  element  of  the  desired  rotation  vector  in  the  CSC 
aerodyn_stealth_simul. 


desired_rot_vel[Z]  =  pedal  pedal  sign(pedal); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.2.5  Stab_aug_pitch_integrator 

Stab_aug_pitch_integrator  is  a  variable  defining  the  integrator  for  the 
stabilization  augmentation  pitch  axis. 
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The  variable  stab_aug_pitch_mtegrator  is  initialized  during  execution  of  the 
CSU  aerodyn_init,  called  by  CSC  rwa_mit.  Execution  of  the  CSU 
aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.2.  -  Aerodynamics  Initialization  Data 
Array  for  a  summary  of  the  variable. 


stab_aug_pitch_integrator  =  .aero_init[  4]; 


3.2.5.2  Usage 

During  real-time  execution,  this  variable  is  not  used. 

See  APPENDIX  B  for  a  complete  source  code  listing. 

3.JZ.6  Stab_aug_roll_integrator 

Stab_aug_roll_mtegrator  is  a  variable  defining  the  integrator  for  the 
stabilization  augmentation  roll  axis. 

3.2.6.1  Initialization 

The  variable  stab_aug_roll_integrator  is  initialized  during  execution  of  the 
CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.2.  -  Aerodynamics  Initialization  Data 
Array  for  a  summary  of  the  variable. 


stab_aug_roll_integrator  =  aero_init[  5]; 


3.2.6.2  Usage 

During  real-time  execution,  this  variable  is  not  used. 

See  APPENDIX  B  for  a  complete  source  code  listing. 

3.2.7  Stab_aug_yaw_integrator 

Stab_aug_yaw_integrator  is  a  variable  defining  the  integrator  for  the 
stabilization  augmentation  yaw  axis. 
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3.2.7.1  Initialization 

The  variable  stab_aug_yaw_iritegrator  is  initialized  during  execution  of  the 
CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.2.  -  Aerodynamics  Initialization  Data 
Array  for  a  summary  of  the  variable. 


stab_aug_yaw_integrator  =  aero_init[  6]; 

3.2.7.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 


I 
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3.2.7.2.1  Algorithm 

The  stab_aug_yaw_integrator  is  computed  and  limited,  then  used  to 
compute  the  stab_aug_yaw  and  the  tail  rotor  control  input  in  the  CSC 
compute_stab_augmentation_gains. 

if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

hover_hold_turned_on  =  TRUE  ; 

I*  You  should  already  be  "hovering”  (airspeed  <10  knots) 
for  hover  hold  to  show  little  visible  swaying.  *! 

stab_aug_yaw_integrator  =  0.0  ; 

»  stab_aug_yaw_mtegrator  -= 

HOVER_AUG_YAW_I_GAIN  *  angular_velocity_vector[Z]; 
if  (stab_aug_yaw_integrator  >  0.5)  stab_aug_yaw_integrator  =  0.5; 
if  (stab_aug_yaw_integrator  <  -0.5)  stab_aug_yaw_integrator  =  -0.5; 
stab_aug_yaw  =  -  HOVER_AUG_YAW_P_GAIN  * 

anguiar_velocity_vector[Z]  +  stab_aug_yaw_integrator; 


stab_aug_yaw  =  limiter  ( 

-MAX_STAB_AUG_YAW_CLIMB_CONTROL, 

stab_aug_yaw, 

MAX  STAB  AUG  YAW_CLIMB_CONTROL); 


else 

{ 

stab_aug_yaw  =  0.0; 

} 

controller_tail_rotor  =  pedal  +  stab_aug_yaw; 

.... 


See  APPENDIX  B  for  a  complete  source  code  listing. 
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3.2.8  Stab_aug_climb_integrator 

Stab_aug_climb_integrator  is  a  variable  defining  the  integrator  for  the 
stabilization  augmentation  climb  axis. 

3.2.8.1  Initialization 

The  variable  stab_aug_climbJntegrator  is  initialized  during  execution  of 
CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.2.  -  Aerodynamics  Initialization  Data 
Array  for  a  summary  of  the  variable. 


stab_aug_climb_integrator  =  aero_init[  7]; 


3.2.8.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.2.8.2.1  Algorithm 

The  stab_aug_climb_irtlogrator  is  computed  and  limited,  then  used  to 
compute  the  stab_aug_climb  and  the  tail  rotor  control  input  in  the  CSC 

compute_stab_augmentation_gains. 


if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

hover_hold_turned_on  =  TRUE  ; 

I*  You  should  already  be  "hovering"  (airspeed  <  10  knots) 
for  hover  hold  to  show  little  visible  swaying.  * ! 

stab_aug_climb_integrator  =  0.0  ; 

stab_aug_climb_integrator  -= 

HOVER_AUG_CLIMB_I_GAIN  velocity_vector[Z]; 
if  (stab_aug_climb_integrator  >  0.2)  stab_aug_climb_integrator  =  0.2, 
if  (stab_aug_climb_integrator  <  -0.2)  stab_aug_climb_integrator  =  -0.2, 
stab_aug_climb  =  -  HOVER_AUG_CLIMB_P_GAEvJ  * 
velocity_vector[Z]  +  stab_aug_climbJntegrator; 

stab_aug_climb  =  limiter  ( _ _ _ _ _ 
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^  -MAX_STAB_AUG_YAW_CLIMB_CONTROL, 
stab_aug_climb, 

MAX_STAB_AUG_YAW_CLIMB_CONTROL); 

.... 

else 

{ 

stab_aug_climb  =  0.0; 

controller_collective  =  collective  +  stab_aug_cliinb; 

See  APPENDIX  B  for  a  complete  source  code  listing. 

3.2.9  Attitude_control_pitch_integrator 

Attitude_control_pitch_integrator  is  a  variable  defining  the  integrator  for  the 
attitude  control  pitch  axis. 

3.2.9.1  Initialization 

The  variable  attitude_control_pitchJntegrator  is  initialized  during 
execution  of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the 
CSU  aerodynjnit  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.2.  -  Aerodynamics  Initialization 
Data  Array  for  a  summary  of  the  variable. 

attitude_control_pitchJntegrator  =  aero_init[  8]; 

3.2.9.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.2.9.2.1  Algorithm 

The  attitude_control_pitchjntegrator  is  computed  and  limited,  then  used  to 
compute  the  attitude_control_pitch_command  in  the  CSC 
set_pitch_attitude. 
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attitude_control_pitch_integrator  += 

ATT_CTL_PITCH_I_GAIN  *  (pitch  -  angle); 
a  ttitude_con  trol_pitch_in  tegra  tor  = 

limiter  (-0.1,  attitude_control_pitch_integrator,  0.1); 
attitude_control_pitch_command  =  ATT_CTL_PITCH_P_GAIN 
(pitch  -  angle); 

attitude_control_pitch_command  +=  attitude_control_pitch_integrator; 
attitude_control_pitch_command  =  limiter  ( 

-MAX_STAB_AUG_PITCH_ROLL_CONTROL, 

attitude_control_pitch_command, 

MAX_STAB_AUG_PITCH_ROLL_CONTROL); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.2.10  Attitude_control_roll_integrator 

Attitude_control_roll_integrator  is  a  variable  defining  the  integrator  for  the 
attitude  control  roll  axis. 

3.2.10.1  Initialization 

The  variable  attitude_control_roll_integrator  is  initialized  during  execution 
of  the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.2.  -  Aerodynamics  Initialization  Data 
Array  for  a  summary  of  the  variable. 


attitude_control_roll_integrator  =  aero_init[  9]; 


3.2.10.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.2.10.2.1  Algorithm 

The  attitude_control_roll_integrator  is  computed  and  limited,  then  used  to 
compute  the  attitude_control_roll_command  in  the  CSC  set_roll_attitude. 
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attitude_control_roll_integrator  +=  ATT_CTL_ROLL_I_GAIN  * 

(roll  -  angle); 

attitude_control_roll_integrator  = 

limiter  (-0.1,  attitude_control_roll_integrator,  0.1); 
attitude_control_roll_command  =  ATT_CTL_ROLL_P_GAIN 
(roll  -  angle); 

attitude_control_roll_command  +=  attitude_control_roll_integrator; 
attitude_control_roll_command  =  limiter  ( 

-MAX_STAB_AUG_PITCH_ROLL_CONTROL, 

attitude_control_roll_command, 

MAX  STAB_AUG_PITCH_ROLL_CONTROL); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.2,11  Hover_aug_pitch_integrator 

Hover_aug_pitch_integrator  is  a  variable  defining  the  integrator  for  the 
hover  augmentation  pitch  axis. 

3.2.11.1  Initialization 

The  variable  hover_aug_pitch_integrator  is  initialized  during  execution  of 
the  CSU  aerodyn_init,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.2.  -  Aerodynamics  Initialization  Data 
Array  for  a  summary  of  the  variable. 


hover_aug_pitch_integrator  =  aero_init[10]; 


3.2.11.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.2.11.2.1  Algorithm 

The  hover_aug_pitch_integrator  is  computed  and  limited,  then  used  to 
compute  the  hover_aug_pitch_angle  in  the  CSC 
compute_stab_augmentation_gains. 
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if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

hover_hold_turned_on  =  TRUE  ; 

I*  You  should  already  be  "hovering"  (airspeed  <  10  knots) 
for  hover  hold  to  show  little  visible  swaying.  */ 

hover_aug_pitch_integrator  = 

HOVER, AUG_PITCH_RESET_VALUE  ; 

hover_aug_pitch_integrator  += 

HOVER, AUG_PITCH_I_GAIN  velocity_vector[Y]; 

hover,aug_pitch_integrator  = 

limiter  (-0.2,hover_aug,pitch,integrator,0. 2); 
hover,aug,pitch,angle  =  HOVER,AUG,PITCH,P,GAIN  * 
velocity  ,vector[Y] 

»  +  hover,aug_pitch,integrator; 

hover,aug,pitch,angle  =  limiter  (-M AX, ATT_CTL, ANGLE, 

hover,aug,pitch_angle, 

MAX,  ATT,CTL_  ANGLE); 

stab_aug,pitch  =  set_pitch_attitude  (hover_aug_pitch_angle); 

.... 

else 

{ 

#ifdef  notdef 

hover_aug,pitch,integrator  =  0.0; 

#endif 

.... 

.... 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.2.12  Hover_aug,roll_integrator 

Hover,aug,roll,integrator  is  a  variable  defining  the  integrator  for  the  hover 
augmentation  roll  axis. 
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3.2.12.1  Initialization 

The  variable  hover_aug_roll_integrator  is  initialized  during  execution  of  the 
CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.2.  -  Aerodynamics  Initialization  Data 
Array  for  a  summary  of  the  variable. 


hover_aug_roll_integrator  =  aero_init[ll]; 


3.2.12.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.2.12.2.1  Algorithm 

The  hover_aug_roll_integrator  is  computed  and  limited,  then  used  to 
compute  the  ho  ver_aug_roll_angle  in  the  CSC 

c6mpute_stab_augmentation_gains. 

if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hoid_turned_on  ) 

{ 

hover_hold_turned_on  =  TRUE  ; 

I*  You  should  already  be  "hovering"  (airspeed  <  10  knots) 
for  hover  hold  to  show  little  visible  swaying.  */ 

hover_aug_pitch_integrator  =  0.0  ; 

hover_aug_roll_integrator  += 

HOVER_AUG_ROLL_I_GAIN  velocity_vector[X]; 
hover_aug_roll_integrator  = 

limiter(-0.2,hover_aug_roll_integrator,0.2); 
hover_aug_roll_angle  =  HOVER_AUG_ROLL_P_GAIN 
velocity_vector[X] 

+  hover_aug_roli_integrator; 

hover_aug_roll_angle  =  limiter  (-MAX_ATT_CTL_ANGLE, 
hover_aug_roll_angle, 

MAX_ATT_CTL_  ANGLE); 

stab_aug_roll  =  set_roll_attitude  (hover_aug_roll_angle); 
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} 

else 

{ 

#ifdef  notdef 

hover_aug_roll_integrator  =  0.0; 

#endif 

} 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.2.13  Hover_aug_pitch_angle 

Hover_aug_pitch_angle  is  a  variable  defining  the  integrator  for  the 
stabilization  augmentation  climb  axis. 

3.2.13.1  Initialization 

The  variable  hover_aug_pitch_angle  is  initialized  during  execution  of  the 
CSU  aerodynjnit,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.2.  -  Aerodynamics  Initialization  Data 
Array  for  a  summary  of  the  variable. 


hover_aug_pitch_angle  =  aero_init[12]; 


3.2.13.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.2.13.2.1  Algorithm 

The  hover_aug_pitch_angle  is  computed  from  the 
hover_aug_pitch_integrator  and  y-element  of  the  velocity _vector  in  the  CSC 
compute_stab_augmentation_gains. 
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if  (hover_hold_state  ==  ON) 

{ 

■  if  (  !hover_hold_turned_on  ) 

( 

hover_hold_turned_on  =  TRUE  ; 

I*  You  should  already  be  "hovering”  (airspeed  <10  knots) 
for  hover  hold  to  show  little  visible  swaying.  *! 

hover_aug_pitch_integrator  = 

HOVER_AUG_PITCH_RESET_ VALUE  ; 

hover_aug_pitch_integrator  += 

HOVER_AUG_PITCH_I_GAIN  velocity_vector[Y]; 
hover_aug_pitch_integrator  = 

limiter(-0.2,hover_aug_pitch_integrator,0.2); 
hover_aug_pitch_angle  =  HOVER_AUG_PITCH_P_GAIN  * 
velocity_vector[Y] 

'  +  hover_aug_pitch_integrator; 

hover_aug_pitch_angle  =  limiter  (-MAX_ATT_CTL_ANGLE, 

hover_aug_pitch_angle, 

MAX_ATT_CTL_ANGLE); 

stab_aug_pitch  =  set_pitch_attitude  (hover_aug_pitch_angle); 

.... 

else 

{ 

#ifdef  notdef 

hover_aug_pitch_integrator  =  0.0; 

!#endif 

.... 

} 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.2.14  Hover_aug_roll_angle 

Hover_aug_roll_angle  is  a  variable  defining  the  integrator  for  the 
stabilization  augmentation  climb  axis. 
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3.2.14.1  Initialization 

The  variable  hover_aug_roll_angle  is  initialized  during  execution  of  the 
CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.2.  -  Aerodynamics  Initialization  Data 
Array  for  a  summary  of  the  variable. 


hover_aug_roll_angle  =  aero_init[13]; 


3.2.14.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.2.14.2.1  Algorithm 

The  hover_aug_roll_angle  is  computed  from  the  hover_aug_roll_integrator 
ai;id  the  x-element  of  the  velocity_vector  in  the  CSC 
compute_stab_augmentation_gains. 


if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

hover_hold_turned_on  =  TRUE  ; 

You  should  already  be  "hovering"  (airspeed  <10  knots) 
for  hover  hold  to  show  little  visible  swaying.  * ! 

hover_aug_pitch_integrator  =  0.0  ; 

hover_aug_roll_integrator  += 

HOVER_AUG_ROLL_I_GAIN  velocity_vector[X]; 

hover_aug_roll_integrator  = 

limiter(-0.2,hover_aug_roll_integrator,0.2); 

hover_aug_roll_angle  =  HOVER_AUG_ROLL_P_GAIN 
velocity  _vector[X] 

+  hover_aug_roll_integrator; 

hover_aug_roll_angle  =  limiter  (-MAX_ATT_CTL_ANGLE, 
hover_aug_roll_angle, 

MAX_ATT_CTL_  ANGLE); 

stab_aug_roll  =  set_roll_attitude  (hover_aug_roll_angie); 
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} 

else 

{ 

#ifdef  notdef 

hover_aug_roll_integrator  =  0.0; 

#endif 

’  } 

.... 


See  APPENDIX  B  for  a  complete  source  code  .listing. 
3.3  Aero_simple 


This  data  array  consists  of  characteristics  and  parameters  describing  the 
physical  vehicle  and  its  aerodynamic  performance  and  control  in  the 
"simple"  mode.  The  following  constants  are  for  the  simplified  dynamics 
model.  The  model  is  a  modification  of  the  aerodynamics  model  from  the 
SAP.  Global  variables  defined  for  the  real  aerodynamics  are  re-used  here  to 
allow  overlap  in  generic  routines  for  operations  such  as  control  inputs,  init, 
etc. 

3.3.1  MAX_HELICOPTER_POWER 

MAX_HELICOPTER_POWER  is  a  constant  defining  the  maximum  helicopter 
power. 

3.3.1.1  Initialization 

The  constant  MAX_HELICOPTER_POWER  is  initialized  during  execution  of 
the  CSU  aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
aerodyn_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.3.  -  Aerodynamics  Simple  Data  Array 
for  a  summary  of  the  constant. 


#define  MAX_HELICOPTER_POWER  aero_simple[  0] 


3.3.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.3.1.2.1  Algorithm 

MAX_HELICOPTER_POWER  is  used  to  limit  the  maximum  power  of  the 
vehicle  during  execution  of  the  CSU  aerodyn_simple_simul. 


See  APPENDIX  B  for  a  complete  source  code  listing. 


3.3.2  MAX_HH 

MAX_HH  is  a  constant  defining  the  maximum  hover  hold  input. 

3.3.2.1  Initialization 

The  constant  MAX_HH  is  initialized  during  execution  of  the  CSU 
aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.3.  -  Aerodynamics  Simple  Data  Array  for  a 
summary  of  the  constant. 


#define  MAX_HH  aero_simple[  1] 


3.3.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.3.2.2.1  Algorithm 

MAX_HH  is  used  to  limit  the  hover  hold  control  inputs  of  the  vehicle 
during  execution  of  the  CSU  aerodyn_simple_simul. 


if  (hover_hold_state  ==  ON) 

{ 

hover_hold_additions[0]  =  min(velocity_vector[l] 

H_KH,MAX_HH); 

hover_hold_additions[0]  =  max(hover_hold_additions[0],-MAX_HH); 
hover_hold_additions[l]  =  min(-  velocity _vector[0]  * 

H_KH,MAX_HH); 

hover_hold_additions[l]  =  max(hover_hold_additions[l],-MAX_HH); 
hover_hold_additions[2]  =  -  velocity_vector[2]  H_KH  H_CHH; 

}  _ _ _ 
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else 

{ 

hover_hold_additions[0]  =  0; 
hover_hold_additions[l]  =  0; 
hover_hold_additions[2]  =  0; 

} 


See  APPENDIX  B  for  a  complete  source  code  listing. 
3.3.3  H  K1 


H_K1  is  a  constant  defining  the  gain  on  position  error. 

3.3.3.1  Initialization 

The  constant  H_K1  is  initialized  during  execution  of  the  CSU  aerodyn_init, 
called  by  CSC  rwa_iuit.  Execution  of  the  CSU  aerodyn_init  is  normally  done 
oijily  once  during  CSCI  initialization  and  is  performed  sequentially.  See 
TABLE  5.1.3.  -  Aerodynamics  Simple  Data  Array  for  a  summary  of  the 
constant. 


#define  H_K1 


aero_simple[  2] 


3.3.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.3.3.2.1  Algorithm 

H_K1  is  used  to  compute  the  angular  velocity  necessary  to  achieve  the 
desired  orientation  in  exactly  one  tick,  (delta  theta/  delta  T).  Then  get  the 
angular  acceleration  needed  to  get  to  that  velocity  in  one  frame  for  the 
vehicle  during  execution  of  the  CSU  aerodyn_simple_simul. 


for  (i  =  X;  i  <=  Z;  ++i) 

{ 

vec_ptr[i]  =  ((des_ptr[i]  -  cur_ptr[i])  /  DELTA_T  /  H_K1); 
angular_accel[i]  =  (vec_ptr[i]  -  angular_velocity_vector[i]) 

/  DELTA_T; 

res_ptr[i]  =  MOMENT_OF_E'JERTIA_X  angular_accel[i]; 

} 
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See  APPENDIX  B  for  a  complete  source  code  listing. 

3.3.4  H_K2 

H_K2  is  a  constant  defining  the  gain  on  gravity  term  of  power  setting. 

3.3.4.1  Initialization 

The  constant  H_K2  is  initialized  during  execution  of  the  CSU  aerodynjnit, 
called  by  CSC  rwa_mit.  Execution  of  the  CSU  aerodynjnit  is  normally  done 
only  once  during  CSCI  initialization  and  is  performed  sequentially.  See 
TABLE  5.1.3.  -  Aerodynamics  Simple  Data  Array  for  a  summary  of  the 

constant. 

#define  H_K2  aero_simple[  3] 


343.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.3.4.2.1  Algorithm 

H_K2  is  used  to  compute  power  of  the  stealth  vehicle  during  execution  of  the 
CSU  aerodyn_simple_simul. 

power  +=  gross_weight  *  collective/ (H_K2+collective)  *  1.25; 

See  APPENDIX  B  for  a  complete  source  code  listing. 

3.3.5  H_K7 

H_K7  is  a  constant  defining  the  air  drag  coefficient. 

3.3.5.1  Initialization 

The  constant  H_K7  is  initialized  during  execution  of  the  CSU  aerodyn_mit, 
called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodynjnit  is  normally  done 
only  once  during  CSCI  initialization  and  is  performed  sequentially.  See 
TABLE  5.1.3.  -  Aerodynamics  Simple  Data  Array  for  a  summary  of  the 
constant. 
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#define  H_K7 


aero_simple[  4] 


3.3.5.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.3.5.2.1  Algorithm 

H_K7  is  used  to  compute  the  drag  force  in  the  y-axis  of  the  stealth  vehicle 
during  execution  of  the  CSU  aerodyn_simple_simul. 

drag_ptr[Y]  =  square(cur_ptr[Y])  H_K7; 

See  APPENDIX  B  for  a  complete  source  code  listing. 

3.3.6  H_K8 

H_K8  is  a  constant  defining  the  air  drag  coefficient. 

3.3.6.1  Initialization 

The  constant  H_K8  is  initialized  during  execution  of  the  CSU  aerodynjnit, 
called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is  normally  done 
only  once  during  CSCI  initialization  and  is  performed  sequentially.  See 
TABLE  5.1.3.  -  Aerodynamics  Simple  Data  Array  for  a  summary  of  the 
constant. 


#define  H_K8  aero_simple[  5] 

3.3.6.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.3.6.2.1  Algorithm 

H_K8  is  used  to  drag  force  in  the  x-  and  z-axes  of  the  vehicle  during  execution 
of  the  CSU  aerodyn_simple_simul. 
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drag_ptr[X]  =  square(cur_ptr[X])  *  H_K8; 
drag_ptr[Z]  =  square(cur_ptr[Z])  H_K8; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.3.7  H_KP 

H_KP  is  a  constant  gain  defining  the  power  relationship  with  the  collective 
input. 

3.3.7.1  Initialization 

The  constant  H_KP  is  initialized  during  execution  of  the  CSU  aerodynjnit, 
called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodynjnit  is  normally  done 
only  once  during  CSCI  initialization  and  is  performed  sequentially.  See 
TABLE  5.1.3.  -  Aerodynamics  Simple  Data  Array  for  a  summary  of  the 
constant. 

t 

#define  H_KP  aero_simple[  6] 


3.3.7.2  Usage 

During  real-time  execution/ this  constant  is  not  recomputed. 

3.3.7.2.1  Algorithm 

H_KP  is  used  to  compute  power  of  the  stealth  vehicle  during  execution  of  the 
CSU  aerodyn_simple_simul. 


power  =  H_KP  colljactor  +  hover_hold_additions[2]; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.3.8  H_KPR 

H_KPR  is  a  constant  defining  the  pitch/ roll  constant,  approximately  pi/3. 

3.3.8.1  Initialization 

The  constant  H_KPR  is  initialized  during  execution  of  the  CSU  aerodynjnit, 
called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodynjnit  is  normally  done 
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only  once  during  CSCI  initialization  and  is  performed  sequentially.  See 
TABLE  5.1.3.  -  Aerodynamics  Simple  Data  Array  for  a  summary  of  the 
constant. 


#define  H_KPR  aero_simple[  7] 


3.3.8.2  Usage 

During  real-time  execution,  this,  constant  is  not  recomputed. 

3.3.8.2.1  Algorithm 

H_KPR  is  used  to  compute  the  torque  required  to  achieve  the  desired 
orientation  in  pitch  and  roll  of  the  vehicle  during  execution  of  the  CSU 
aerodyn_simple_simul. 

,  orient_vec[0]  =  H_KPR  *  -  cyclic_pitch  +  hover_hold_additions[0]; 
orient_vec[l]  =  H_KPR  *  cyclic_roll  +  hover_hold_additions[l]; 

See  APPENDIX  B  for  a  complete  source  code  listing. 

3.3.9  H_KY 

H_KY  is  a  constant  defining  the  yaw  constant,  approximately  pi/2. 

3.3.9.1  Initialization 

The  constant  H_KY  is  initialized  during  execution  of  the  CSU  aerodynjnit, 
called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodynjnit  is  normally  done 
only  once  during  CSCI  initialization  and  is  performed  sequentially.  See 
TABLE  5.1.3.  -  Aerodynamics  Simple  Data  Array  for  a  summary  of  the 
constant. 


#define  H_KY  aero_simple[  8] 

3.3.9.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.3.9.2.1  Algorithm 

H  KY  is  used  to  compute  the  torque  required  to  achieve  the  desired 
orientation  in  yaw  of  the  vehicle  during  execution  of  the  CSU 
aerodyn_simple_simul. 


orient_vec[2]  =  kinematics_get_yaw  ()  +  sign(pedal)  *  pedal 
pedal  H_KY; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.3.10  H_KH 

H_KH  is  a  constant  defining  the  hover  hold  gain  on  velocity  term. 

3.3.10.1  Initialization 

The  constant  H_KH  is  initialized  during  execution  of  the  CSU  aerodynjnit, 
called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodynjnit  is  normally  done 
only  once  during  CSCI  initialization  and  is  performed  sequentially.  See 
TABLE  5.1.3.  -  Aerodynamics  Simple  Data  Array  for  a  summary  of  the 
constant. 


#define  H_KH  aero_simple[  9] 


3.3.10.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.3.10.2.1  Algorithm 

H_KH  is  used  to  modify  the  computed  limit  on  the  velocity  vector  as  an 
input  to  hover  hold  of  the  vehicle  during  execution  of  the  CSU 
aerodyn_simple_simul. 


if  (hover_hold_state  ==  ON) 

hover_hold_additions[0]  =  min(velocity_vector[l]  * 

H_KH,MAX_HH); 

hover_hold_additions[0]  =  max(hover_hold_additions[0],-MAX_HH); 
hover _hold_additions[l]  =  min(-  velocity_vector[0]  _ _ 
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H_KH,MAX_HH); 

hover_hold_additions[l]  =  max(hover_hold_additions[l],-MAX_HH); 
hover_hold_additions[2]  =  -  velocity _vector [2]  *  H_KH  * 

} 

else 

{ 

hover_hold_additions[0]  =  0; 
hover_hold_additions[l]  =  0; 
hover_hold_additions[2]  =  0; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.3.11  H_CHH 

H_CHH  is  a  constant  defining  the  collective  hover  hold  gain. 

3.3.11.1  Initialization 

t 

The  constant  H_CHH  is  initialized  during  execution  of  the  CSU 
aerodynjnit,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.3.  -  Aerodynamics  Simple  Data  Array  for  a 
summary  of  the  constant. 


#define  H_CHH  aero_simple[10] 


3.3.11.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.3.11.2.1  Algorithm 

H_CHH  is  used  to  computed  of  the  velocity  vector  as  an  input  to  hover  hold 
of  the  vehicle  during  execution  of  the  CSU  aerodyn_simple_simul. 


if  (hover_hold_state  ==  ON) 

{ 

hover_hold_additions[0]  =  min(velocity_vector[l]  * 

H_KH,MAX_HH); 

hover_hold_additions[0]  =  max(hover_hold_additions[0],-MAX_HH); 
hover_hold_additions[l]  =  min(-  velocity_vector[0] 

H_KH,MAX_HH); 
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ho  ver_hold_additions  [1  j 
ho  ver_hold_addi  tions  [2] 

} 

else 

{ 

ho  ver_hold_addi  tions  [0] 
ho  ver_hold_addi  tions  [  1  ] 
ho  ver_hold_a  ddi  tions  [2] 

} 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.3.12  H_CL 

H_CL  is  a  constant  defining  the  coefficient  of  lift. 

3.3.12.1  Initialization 

The  constant  H_CL  is  initialized  during  execution  of  the  CSU  aerodyn_init, 
called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodynjnit  is  normally  done 
only  once  during  CSCI  initialization  and  is  performed  sequentially.  See 
TABLE  5.1.3.  -  Aerodynamics  Simple  Data  Array  for  a  summary  of  the 

constant. 


3.3.12.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 


3.3.12.2.1  Algorithm 

H_CL  is  used  to  compute  the  lift  as  a  function  of  cyclic  pitch  and  velocity  of 
the  vehicle  during  execution  of  the  CSU  aerodyn_simple_simul. 


See  APPENDIX  B  for  a  complete  source  code  listing. 
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3.4  Aero_stealth 

This  data  array  consists  of  characteristics  and  parameters  describing  the 
physical  vehicle  and  its  aerodynamic  performance  and  control  m  the 
"stealth"  mode.  The  following  is  for  the  simplified  model  incorporating  the 
stealth  dynamics.  In  this  model,  the  cyclic  changes  the  desired  velocity. 

3.4.1  H_FWD_MUL 

H  FWD_MUL  is  a  constant  defining  the  slope  of  the  cyclic  pitch  position 
squared  versus  forward  velocity  curve. 

3.4.1.1  Initialization 

The  constant  H_FWD_MUL  is  initialized  during  execution  of  the  CSU 
aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodyn  init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.4.  -  Aerodynamics  Stealth  Data  Array  for  a 
spmmary  of  the  constant. 


#define  H_FWD_MUL  aero_stealth[  0] 


3.4.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.4.1.2.1  Algorithm 

H  FWD_MUL  is  used  to  compute  the  desired  linear  velocity  in  the  forward 
direction  for  the  stealth  vehicle  during  execution  of  the  CSU 
aerodyn_stealth_simul. 


desired_lin_vel[Y]  =  cyclic_pitch  cyclic_pitch  sign  (cyclic_pitch) 
H_FWD_MUL; 


See  APPENDIX  B  for  a  complete  source  code  listing. 
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3.4.2  H_SIDE_MUL 

H_SIDE_MUL  is  a  constant  defining  the  slope  of  the  cyclic  roll  position 
squared  versus  sideward  velocity  curve. 

3.4.2.1  Initialization 

The  constant  H_SIDE_MUL  is  initialized  during  execution  of  the  CSU 
aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodynjnit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.4.  -  Aerodynamics  Stealth  Data  Array  for  a 
summary  of  the  constant. 


#define  H_SIDE_MUL  aero_stealth[  1] 


3.4.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.4.2.2.1  Algorithm 

H_SIDE_MUL  is  used  to  compute  the  desired  linear  velocity  in  the  sideward 
direction  for  the  stealth  vehicle  during  execution  of  the  CSU 
aerodyn_stealth_simul. 


desired_lin_vel[X]  =  cyclic_roll  cyclic_roll  *  sign  (cyclic_roll) 
H_SIDE_MUL; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.4.3  H_COLL_MUL 

H_COLL_MUL  is  a  constant  defining  the  slope  of  the  collective  position 
squared  versus  vertical  velocity  curve. 

3.4.3.1  Initialization 

The  constant  H_COLL_MUL  is  initialized  during  execution  of  the  CSU 
aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.4.  -  Aerodynamics  Stealth  Data  Array  for  a 
summary  of  the  constant. 
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#define  H_COLL_MUL  aero_stealth[  2] 


3.4.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.4.3.2.1  Algorithm 

H_COLL_MUL  is  used  to  compute  the  desired  linear  velocity  in  the  vertical 
direction  for  the  stealth  vehicle  during  execution  of  the  CSU 
aerodyn_stealth_simul. 


desired_lin_vel[Z]  =  adj_collective  *  adj_collective 
sign  (adj_collective  )  *  H_COLL_MUL; 


See  APPENDIX  B  for  a  complete  source  code  hsting. 

3.4.4  MAX.TORQUE 

MAX_TORQUE  is  a  constant  defining  the  maximum  controller  torque  for  the 
stealth  vehicle. 

3.4.4.1  Initialization 

The  constant  MAX_TORQUE  is  initialized  during  execution  of  the  CSU 
aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.4.  -  Aerodynamics  Stealth  Data  Array  for  a 
summary  of  the  constant. 


#define  MAX_TORQUE  aero_stealth[  3] 


3.4.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.4.4.2.1  Algorithm 

MAX_TORQUE  is  used  to  limit  the  controller  torque  for  the  stealth  vehicle 
during  execution  of  the  CSU  aerodyn_stealth_simul. 
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moment_body[X]  =  min  (MAX_TORQUE,  moment_body[X]); 
moment_body[Y]  =  min  (MAX_TORQUE,  moment_body[Y]); 
moment_body[Z]  =  min  (MAX_TORQUE,  moment_body[Z]); 

moment_body[X]  =  max  (-MAX_TORQUE,  moment_body[X]); 
moment_body[Y]  =  max  (-MAX_TORQUE,  moment_body[Y]); 
moment_body[Z]  =  max  (-MAX_TORQUE,  moment_body[Z]); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.4.5  MAX.FORCE 

MAX_FORCE  is  a  constant  defining  the  maximum  controller  force  for  the 
stealth  vehicle. 

3.4.5.1  Initialization 

t 

The  constant  MAX_FORCE  is  initialized  during  execution  of  the  CSU 
aerodyn_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  aerodyn_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.4.  -  Aerodynamics  Stealth  Data  Array  for  a 
summary  of  the  constant. 


#define  MAX_FORCE  aero_stealth[  4] 


3.4.5.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.4.5.2.1  Algorithm 

MAX_FORCE  is  used  to  limit  the  controller  forces  for  the  stealth  vehicle 
during  execution  of  the  CSU  aerodyn_stealth_simul. 
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force_body[X]  =  min  (MAX_FORCE,  force_body[X]); 
force_body[Y]  =  min  (MAX_FORCE,  force_body[Y]); 
force_body[Z]  =  min  (MAX_FORCE,  force_body[Z]); 

force_body[X]  =  max  (-MAX_FORCE,  force_body[X]); 
force_body[Y]  =  max  (-MAX_FORCE,  force_body[Y]); 
force_body[Z]  =  max  (-MAX_FORCE,  force_body[Z]); 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.4.6  MASS 

MASS  is  a  constant  defining  the 

3.4.6.1  Initialization 

The  constant  MASS  is  initialized  during  execution  of  the  CSU  aerodynjnit, 
chlled  by  CSC  rwajnit.  Execution  of  the  CSU  aerodynjnit  is  normally  done 
only  once  during  CSCI  initialization  and  is  performed  sequentially.  See 
TABLE  5.1.4.  -  Aerodynamics  Stealth  Data  Array  for  a  summary  of  the 
constant. 


#define  MASS  aero_stealth[  5] 


3.4.6.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.4.6.2.1  Algorithm 

MASS  is  used  to  compute  the  controller  forces  for  the  stealth  vehicle  during 
execution  of  the  CSU  aerodyn_stealth_simul. 


force_body[X]  =  (desired Jin_vel[X]  -  velocity_vector[X]) 
MASS/DELTA_T; 

force_body[Y]  =  (desired Jin_vel[Y]  -  veiocity_vector[Y]) 
MASS/DELTA_T; 

force_body[Z]  =  (desired Jin_vel[Z]  -  velocity_vector[Z]) 
MASS/DELTA_T; 


See  APPENDIX  B  for  a  complete  source  code  listing. 
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3.4.7  INERTIA 

INERTIA  is  a  constant  defining  the  inertia  of  the  stealth  vehicle. 


3.4.7.1 


Initialization 


The  constant  INERTIA  is  initialized  during  execution  of  the  CSU 
aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodyn  init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.4.  -  Aerodynamics  Stealth  Data  Array  for  a 
summary  of  the  constant. 


#define  INERTIA 


aero  stealth[  6] 


3.4.7.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3!4.7.2.1  Algorithm 

INERTIA  is  used  to  compute  the  controller  torque  for  the  stealth  vehicle 
during  execution  of  the  CSU  aerodyn_stealth_simul. 


moment_body[X]  =  (desired_rot_vel[X]  -  angular_velocity_vector[X]) 
INERTIA/DELTA_T; 

moment_body[Y]  =  (desired_rot_vel[Y]  -  angular_velocity_vector[Yj) 
INERTIA/DELTA_T; 

moment_body[Z]  =  (desired_rot_vel[Z]  -  angular_velocity_vector[Z]) 
INERTIA/DELTA_T; 


See  APPENDIX  B  for  a  complete  source  code  listing. 

3.4.8  DEAD_ZONE 

DEAD_ZONE  is  a  constant  defining  the  dead  zone  of  the  controls. 


3.4.8.1 


Initialization 


The  constant  DEAD_ZONE  is  initialized  during  execution  of  the  CSU 
aerodynjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  aerodyn  init  is 
normdly  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.4.  -  Aerodynamics  Stealth  Data  Array  for  a 
summary  of  the  constant. 
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#define  DEAD_ZONE  aero_stealth[  7] 


3.4.8.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed  nor  used. 

See  APPENDIX  B  for  a  complete  source  code  listing. 

3.5  Engine_data 

This  data  array  consists  of  characteristics  and  parameters  describing  the  engine 
performance  and  control. 

3.5.1  GOVERNOR_ENGINE_SPEED_SETTING 

The  GOVERNOR_ENGINE_SPEED_SETTING  is  a  constant  defining  the 
ii^aximum  engine  speed  setting  at  100  percent  rpm. 

3.5.1.1  Initialization 

The  constant  GOVERNOR_ENGINE_SPEED_SETTING  is  initialized  during 
execution  of  the  CSU  enginejnit,  called  by  CSC  rwajnit.  Execution  of  the 
CSU  enginejnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.5.  -  Engine  Data  Array  for  a  summary 
of  the  initialization  variable. 


#define  GOVERNOR_ENGINE_SPEED_SETTING  engine_data[  0] 


3.5.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.5.1.2.1  Algorithm 

Engine  power  is  computed  as  a 

GOVERNOR_ENGINE_SPEED_SETTING. 


engine_power  =  gov_p_gain 

(GOVERNOR_ENGINE_SPEED_SETTING  -  engine_speed); 
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If  the  engine  is  working,  GOVERNOR_ENGINE_SPEED_SETTING  is  used  to 
conapute  the  integrator_gain. 


if  (engine_status  ==  WORKING) 

{ 

integrator_gain  +=  gov_i_gain 

(G0VERN0R_ENGINE_SPEED_SETTING  -  engine_speed); 
if  (integrator_gain  >  0.5) 
integrator_gain  =  0.5; 
else  if  (integrator_gain  <  -0.5) 
integrator_gain  =  -0.5; 

engine_power  +=  integrator_gain; 

} 

else  I*  Damaged  *! 

{ 

integrator_gain  =  0.0; 
if  (engine_power  >  0.7) 
engine_power  =  0.7; 

} 


The  constant  GOVERNOR_ENGINE_SPEED_SETTING  is  used  to  compute 
powertrain_percent_shaft_speed. 


powertrain_percent_shaft_speed  =  engine_speed  / 
GOVERNOR_ENGINE_SPEED_SETTING; 


See  APPENDIX  C  for  a  complete  source  code  listing. 

3.5.2  GOVERNOR_P_GAIN 

The  GOVERNOR_P_GAIN  is  a  constant  defining  the  maximum  engine 
speed  gain. 

3.5.2.1  Initialization 

The  constant  GOVERNOR_P_GAIN  is  initialized  during  execution  of  the 
CSU  enginejnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  enginejnit 
is  normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.5.  -  Engine  Data  Array  for  a  summary  of  the 
initialization  variable. 
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#define  GOVERNOR_P_GAIN  engine_data[  1] 

3.5.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.5.2.2.1  Algorithm 

Engine  variable  gov_p_gain  is  initialized  during  execution  of  CSC 
engine_init  to  GOVERNOR_P_GAIN. 


The  variable  gov_p_gain  is  used  to  compute  engine_power.  The  variable 
gov_p_gain  is  not  recomputed  during  execution  of  CSU  engine_simul. 

engine_power  =  gov_p_gain 

(GOVERNOR_ENGINE_SPEED_SETTING  -  engine_speed); 

See  APPENDIX  C  for  a  complete  source  code  listing. 

3.5.3  GOVERNOR_I_GAIN 

The  GOVERNOR_I_GAIN  is  a  constant  defining  the  maximum  engine  speed 
gain  rate  of  the  integrator. 

3.5.3.1  Initialization 

The  constant  GOVERNOR_I_GAIN  is  initialized  during  execution  of  the 
CSU  enginejnit,  called  by  CSC  rwa_init.  Execution  of  the  CSU  enginejnit 
is  normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.5.  -  Engine  Data  Array  for  a  summary  of  the 
initialization  variable. 

#define  GOVERNOR_I_GAIN  engine_data[  2] 

3.5.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.5.3.2.1  Algorithm 


Engine  variable  govJ_gain  is  initialized  during  execution  of  CSC 
engine_init  to  GOVERNOR_I_GAIN. 


gov_i_gain  = 


GOVERNOR_I_GAIN; 


If  the  engine.status  is  WORKING,  the  variable  gov_i_gain  is  used  to 
compute  integrator_gain.  The  variable  gov_p_gain  is  not  recomputed 
during  execution  of  CSU  engine_simul. 


if  (engine_status  ==  WORKING) 

r 

integrator_gain  +=  gov_i_gair^  *  .  jn 

(GOVERNOR_ENGINE_SPEED_SETTING  -  engme_speed); 

if  (integrator_gain  >  0.5) 
integrator_gain  =  0.5; 
else  if  (integrator_gain  <  -0.5) 
integrator_gain  =  -0.5; 


engine_power  +=  integrator_gain; 

else  /*  Damaged  V 

{ 

integrator_gain  =  0.0; 
if  (engine_power  >  0.7) 
engine_power  =  0.7; 


See  APPENDIX  C  for  a  complete  source  code  listing. 


3.5.4  MAX_ENGINE_TORQUE 

The  MAX_ENGINE_TORQUE  is  a  constant  defining  the  maximum  engine 
torque. 

3.5.4.1  Initialization 

The  constant  MAX_ENGINE_TORQUE  is  initialized  during  execution  of  the 
CSU  enginejnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  engme_mit 
is  normally  done  only  once  during  CSCI  initialization  and  is  performe 


-121- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 

sequentially.  See  TABLE  5.1.5.  -  Engine  Data  Array  for  a  summary  of  the 
initialization  variable. 


#define  MAX_ENGINE_TORQUE  engine_data[  3] 


3.5.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.5.4.2.1  Algorithm 

The  constant  MAX_ENGINE_TORQUE  is  used  to  compute  the 
engine_percent_torque. 

engine_percent_torque  =  engine_drive_torque  / 

(MAX_ENGINE_TORQUE  *  number_of_engines); 

I  _ _  - 

See  APPENDIX  C  for  a  complete  source  code  listing. 

3.5.5  MIN_ENGINE_LOAD_TORQUE 

The  MIN_ENGINE_LOAD_TORQUE  is  a  constant  defining  the  minimum 
engine  load  torque. 

3. 5.5.1  Initialization 

The  constant  MIN_ENGINE_LOAD_TORQUE  is  initialized  during  execution 
of  the  CSU  engine_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
engine_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.5.  -  Engine  Data  Array  for  a  siunmary 
of  the  initialization  variable. 

#define  MIN_ENGINE_LOAD_TORQUE  engine_data[  4] 


3.5.5.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.5.5.2.1  Algorithm 

The  constant  MIN_ENGINE_LOAD_TORQUE  is  used  to  set  the  lower  linait 
of  engine_load_torque. 

if  (engine_load_torque  <  MIN_ENGINE_LOAD_TORQUE) 
engine_load_torque  =  MIN_ENGINE_LOAD_TORQUE; 

See  APPENDIX  C  for  a  complete  source  code  listing. 

3.5.6  MAX_ENGINE_PERCENT_POWER 

The  MAX_ENGINE_PERCENT_POWER  is  a  constant  defining  the 
maximum  engine  percent  of  power  available. 

3.5.6.1  Initialization 

The  constant  MAX_ENGINE_PERCENT_POWER  is  initialized  during 
execution  of  the  CSU  engine_init,  called  by  CSC  rwa_init.  Execution  of  the 
CSU  enginejnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.5.  -  Engine  Data  Array  for  a  summary 
of  the  initialization  variable. 


#define  MAX_ENGINE_PERCENT_POWER  engine_data[  5] 


3.5.6.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.5.6.2.1  Algorithm 

If  engine_power  is  greater  than  MAX_ENGINE_PERCENT_POWER, 
engine_power  is  limited  to  the  MAX_ENGINE_PERCENT_POWER. 

if  (engine_power  >  MAX_ENGINE_PERCENT_POWER) 
engine_power  =  MAX_ENGINE_PERCENT_POWER; 


See  APPENDIX  C  for  a  complete  source  code  listing. 
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3.5.7  ENGINE_TORQUE_INTERCEPT 

The  ENGINE_TORQUE_INTERCEPT  is  a  constant  defining  the  engine 
torque  curve  intercept  for  the  linear  engine  torque  equation. 

3.5.7.1  Initialization 

The  constant  ENGINE_TORQUE_INTERCEPT  is  initialized  during  execution 
of  the  CSU  enginejnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
enginejnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.5.  -  Engine  Data  Array  for  a  summary 
of  the  initialization  variable. 


#define  ENGINE_TORQUE_INTERCEPT  engine_data[  6] 


3.5.7.2  Usage 

Dliring  real-time  execution,  this  constant  is  not  recomputed. 

3.5.7.2.1  Algorithm 

The  constant  ENGINE_TORQUE_INTERCEPT  is  used  to  compute 
engine_drive_torque. 

engine_drive_torque  =  engine_power  *  number_of_engines  * 

(ENGINE_TORQUE_INTERCEPT  -  ENGINE_TORQUE_SLOPE  * 
engine_speed); 


See  APPENDIX  C  for  a  complete  source  code  listing. 

3.5.8  ENGINE_TORQUE_SLOPE 

The  ENGINE_TORQUE_SLOPE  is  a  constant  defining  the  engine  torque 
curve  slope  for  the  linear  engine  torque  equation. 

3.5.8.1  Initialization 

The  constant  ENGINE_TORQUE_SLOPE  is  initialized  during  execution  of 
the  CSU  engine_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
engine_init  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.5.  -  Engine  Data  Array  for  a  summary 
of  the  initialization  variable. 


-124- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


#define  ENGINE_TORQUE_SLOPE  engine_data[  7] 


3.5.8.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.5.8.2.1  Algorithm 

The  constant  ENGINE_TORQUE_SLOPE  is  used  to  compute 
engine_drive_torque. 


engine_drive_torque  =  engine_power  number_of_engines 

(ENGINE_TORQUE_INTERCEPT  -  ENGINE_TORQUE_SLOPE 
engine_speed); 

/• 

t 

See  APPENDIX  C  for  a  complete  source  code  listing. 

3.5.9  NOSE_GEARBOX_RATIO 

The  NOSE_GEARBOX_RATIO  is  a  constant  defining  the  nose  gearbox  ratio. 

3.5.9.1  Initialization 

The  constant  NOSE_GEARBOX_RATIO  is  initialized  during  execution  of  the 
CSU  engine_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  engine_init 
is  normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.5.  -  Engine  Data  Array  for  a  summary  of  the 
initialization  variable. 


#define  NOSE_GEARBOX_RATIO  engine_data[  8] 

3.5.9.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.5.9.2.1  Algorithm 

NOSE_GEARBOX_RATIO  is  used  to  compute  turbine  speed. 
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turbine_speed  =  engine_speed  *  NOSE_GEARBOX_RATIO; 


See  APPENDIX  C  for  a  complete  source  code  listing. 

3.5.10  MAIN_ROTOR_GEAR_RATIO 

The  MAIN_ROTOR_GEAR_RATIO  is  a  constant  defining  the  main  rotor 
gear  ratio. 

3.5.10.1  Initialization 

The  constant  MAIN_ROTOR_GEAR_RATIO  is  initialized  during  execution 
of  the  CSU  enginejnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
enginejnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.5.  -  Engine  Data  Array  for  a  summary 
of  the  initialization  variable. 


#define  MAIN_ROTOR_GEAR_RATIO  engine_data[  9] 


3.5.10.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.5.10.2.1  Algorithm 

MAIN_ROTOR_GEAR_RATIO  is  used  to  compute 

main_rotor_engine_load. 

main_rotor_engine_load  =  main_rotor_load  / 
MAIN_R0T0R_GEAR_RATI0; 

MAIN_ROTOR_GEAR_RATIO  is  used  to  compute 

main_rotor_shaft_speed. 

main_rotor_shaft_speed  =  engine_speed  / 

MAIN_ROTOR_GEAR_RATIO; 
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MAIN_ROTOR_GE  AR_RATIO  is  used  to  compute 
main_rotor_drive_torque. 


main_rotor_drive_torque  =  (engine_drive_torque  - 
tail_rotor_engine_load) 
MAIN_ROTOR_GEAR_RATIO; 


See  APPENDIX  C  for  a  complete  source  code  listing. 

3.5.11  TAIL_ROTOR_GEAR_RATIO 

The  TAIL_ROTOR_GEAR_RATIO  is  a  constant  defining  the  tail  rotor  gear 
ratio. 

3.5.11.1  Initialization 

The  constant  TAIL_ROTOR_GEAR_RATIO  is  initialized  during  execution  of 
tl)e  CSU  enginejnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
enginejnit  is  normally  done  only  once  during  CSCI  initialization  and  is 
performed  sequentially.  See  TABLE  5.1.5.  -  Engine  Data  Array  for  a  summary 
of  the  initialization  variable. 


#define  TAIL_ROTOR_GEAR_RATIO  engine_data[10] 

3.5.11.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.5.11.2.1  Algorithm 

TAIL_ROTOR_GEAR_RATIO  is  used  to  compute  tail_rotor_engine_load. 

tail_rotor_engine_load  =  tail_rotor_load  /  TAIL_ROTOR_GEAR_RATIO; 
TAIL_ROTOR_GEAR_RATIO  is  used  to  compute  tail_rotor_shaft_speed. 
tail_rotor_shaft_speed  =  engine_speed  /  TAIL_ROTOR_GEAR_RATIO; 
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See  APPENDIX  C  for  a  complete  source  code  listing. 

3.5.12  POWERTRAINJNERTIA 

The  POWERTRAIN_INERTIA  is  a  constant  defining  the  powertrain  inertia. 
3.5.12.1  Initialization 

The  constant  POWERTRAINJNERTIA  is  initialized  during  execution  of  the 
CSU  enginejnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  enginejnit 
is  normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.5.'  -  Engine  Data  Array  for  a  summary  of  the 
initialization  variable. 

#define  POWERTRAIN_INERTIA  engine_data[ll] 


3.5.12.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.5.12.2.1  Algorithm 

If  engine_status  is  WORKING,  POWERTRAIN_INERTIA  is  used  to  compute 
engine_speed. 


if  (engine_status  ==  WORKING) 

engine_speed  +=  (engine_driveJorque  -  engineJoad_torque) 
/  POWERTRAIN_INERTIA; 


See  APPENDIX  C  for  a  complete  source  code  listing. 

3.5.13  MAX_FUELFLOW 

The  MAX_FUELFLOW  is  a  constant  defining  the  maximum  engine  fuel 
flow. 

3.5.13.1  Initialization 

The  constant  MAX_FUELFLOW  is  initialized  during  execution  of  the  CSU 
enginejnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  enginejnit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.5.  -  Engine  Data  Array  for  a  summary  of  the 
initialization  variable. 
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#define  MAX_FUELFLOW  engine_data[12] 


3.5.13.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.5.13.2.1  Algorithm 

MAX_FUELFLOW  is  used  to  compute  engine  fuel_flow. 

fuel_flow  =  engine_percent_torque  *  MAX_FUELFLOW; 

See  APPENDIX  C  for  a  complete  source  code  listing. 

3.6  Engine_init_data 

This  data  array  consists  of  initial  values  of  the  current  engine  state, 
performance,  and  control. 

3.6.1  Engine_power 

The  variable  engine_power  is  a  computed  variable  defining  the  current  state 
of  engine  power. 

3.6.1.1  Initialization 

The  variable  engine_power  is  initialized  during  execution  of  the  CSU 
engine_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  engine_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.6.  -  Engine  Initialization  Data  Array  for  a 
summary  of  the  initialization  variable. 

engine_power  =  engine_init_data[  0] 


3.6.1.2  Usage 

During  real-time  execution,  this  variable  is  recomputed  each  frame  of  CSC 
engine_simul. 
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If  the  engine  is  out  of  fuel,  the  engine_power  is  set  to  0.0. 


if  (fuel_level_empty  ()) 

( 

!*  Out  of  gas  */ 

1 

engine_power  =  0.0; 
engine  speed  =  0.0; 

} 

The  engine_power  is  then  used  to  compute  the  engine_drive_torque. 


engine_drive_torque  =  engine_power  *  number_of_engines  * 
(ENGINE_TORQUE_INTERCEPT  -  ENGINE_TORQUE_SLOPE 
engine_speed); 


Sde  APPENDIX  C  for  a  complete  source  code  listing. 

3.6.2  Engine_percent_torque 

The  variable  engine_percent_torque  is  a  computed  variable  defining  the 
current  state  of  percent  of  engine  torque. 

3.6.2.1  Initialization 

The  variable  engine_percent_torque  is  initialized  during  execution  of  the 
CSU  enginejnit,  called  by  CSC  rwa_init.  Execution  of  the  CSU  enginejnit 
is  normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.6.  -  Engine  Initialization  Data  Array  for  a 
summary  of  the  initialization  variable. 


engine_percent_torque  =  engine_init_data[  1] 


3.6.2.2  Usage 

During  real-time  execution,  this  variable  is  recomputed  each  frame  of  CSC 
engine_simul. 

3.6.2.2.1  Algorithm 

Percent  of  engine  torque  is  computed  as  a  function  of  engine_drive_torque 
and  number  of  engines. 
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engine_percent_torque  =  engine_drive_torque  / 

(MAX_ENGINE_TORQUE  *  number_of_engines); 


The  engine_percent_torque  is  used  to  compute  the  fuel_flow. 


fuel_flow  =  engine_percent_torque  *  MAX_FUELFLOW; 


If  the  engine  is  starting,  and  the  engine_percent_torque  is  less  than  .0101,  the 
engine  is  not  starting,  limited  to  a  minimum  values.  If  the  engine  is  starting, 
and  the  engine_percent_torque  is  greater  than  or  equal  to  .0101,  the 
engine_percent_torque  is  limited  to  a  value  of  .01. 


if  (starting_engine) 

t 

if  (engine_percent_torque  -  .01  <  .0001)  /*  within  a  delta  */ 

starting_engine  =  FALSE; 
else 

engine_percent_torque  =  .01; 


The  engine_percent_torque  is  output  to  the  torque  meter  display. 


meter_torque_set  (engine_percent_torque); 


The  engine_percent_torque  is  also  used  to  compute  engine  and  rotor  sound. 
See  Appendix  C  for  a  complete  source  code  listing. 

3.6.3  Engine_speed 

The  variable  engine_speed  is  a  computed  variable  defining  the  current  state 
of  engine  speed. 

3.6.3.1  Initialization 

The  variable  engine_speed  is  initialized  during  execution  of  the  CSU 
engine_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  enginejnit  is 
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normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.6.  -  Engine  Initialization  Data  Array  for  a 
summary  of  the  initialization  variable. 


engine_speed  =  enginejnit_data[  2]; 


3.6.3.2  Usage 

During  real-time  execution,  this  variable  is  recomputed  each  frame  of  CSC 
engine_simul. 

3.6.3.2.1  Algorithm 

If  the  engine  is  working,  engine_speed  is  computed  as  an  incremental  change 
each  frame  as  a  function  of  the  difference  between  engine_drive_torque  and 
engine_load_torque. 


t 

if  (engine_status  ==  WORKING) 

engine_speed  +=  (engine_drive_torque  -  engine_load_torque) 
/  POWERTRAINJNERTIA; 


If  the  engine  is  out  of  fuel,  engine_speed  is  set  to  0.0. 


if  (fuel_level_empty  ())  /*  Out  of  gas  */ 

{ 

engine_power  =  0.0; 
engine_speed  =  0.0; 

} 


If  the  engine-speed  is  less  than  0.0,  the  engine_speed  is  limited  to  0.0. 


if  (engine_speed  <  0.0) 
engine_speed  =  0.0; 


If  an  engine  is  broken,  engine_speed  is  set  to  0.0. 
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void  engine_break_engine  () 

{ 

engine_status  =  BROKEN; 
engine_speed  =  0.0; 
number_of_engines  =  1; 


If  the  engine  is  vv^orking,  engine_speed  is  used  to  compute  the 
integrator_gain  for  the  engine_power  computation. 

if  (engine_status  ==  WORKING) 

{ 

integrator_gain  +=  gov_i_gain 

(GOVERNOR_ENGINE_SPEED_SETTING  -  engine_speed); 
if  (integrator_gain  >  0.5) 
integrator_gain  =  0.5; 

'  else  if  (integrator_gain  <  -0.5) 
integrator_gain  =  -0.5; 

engine_power  +=  integrator_gain; 

} 

else  I*  Damaged  *! 

{ 

Integra  tor_gain  =  0.0; 
if  (engine_power  >  0.7) 
engine_power  =  0.7; 

} 


The  engine_speed  is  used  to  compute  the  engine_power. 


engine_power  =  gov_p_gain  * 

(GOVERNOR_ENGINE_SPEED_SETnNG  -  engine_speed); 


The  engine_speed  is  used  to  compute  the  engine_drive_torque. 
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engine_drive_torque  =  engine_power  *  number_of_engines  * 

(ENGINE_TORQUE_INTERCEPT  -  ENGINE_TORQUE_SLOPE 
engine_speed); 


The  engine_speed  is  used  to  compute  the  turbine_speed. 


turbine_speed  =  engine_speed  *  NOSE_GEARBOX_RATIO; 


The  engine_speed  is  used  to  compute  the  main_rotor_shaft_speed. 


main_rotor_shaft_speed  =  engine_speed  / 
MAIN_ROTOR_GEAR_RATIO; 


Tke  engine_speed  is  used  to  compute  the  tail_rotor_shaft_speed. 


tail_rotor_shaft_speed  =  engine_speed  /  TAIL_ROTOR_GEAR_RATIO; 


The  engine_speed  is  used  to  compute  the  powertrain_percent_shaft_speed. 


powertrain_percent_shaft_speed  =  engine_speed  / 
GOVERNOR_ENGINE_SPEED_SETTING; 


See  Appendix  C  for  a  complete  source  code  listing. 

3.6.4  Integrator_gain 

The  variable  integrator_gain  is  a  computed  variable  defining  the  rate  of 
change  for  engine_power  during  each  frame. 

3.6.4.1  Initialization 

The  variable  integrator_gain  is  initialized  during  execution  of  the  CSU 
enginejnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  enginejnit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.6.  -■>  Engine  Initialization  Data  Array  for  a 
summary  of  the  initialization  variable. 
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Integra  to  r_gain  =  engine_init_data[  3]; 


3.6.4.2  Usage 

During  real-time  execution,  this  variable  is  recomputed  each  frame  of  CSC 
engine_simul,  if  the  engine  is  working.. 

3.6.4.2.1  Algorithm 

The  integrator_gain  is  computed  as  a  function  of  engine_speed.  It  is  limited 
to  a  value  between  0.5  and  -0.5.  If  the  engine  is  not  working,  the 
integrator_gain  is  set  to  zero. 


if  (engine_status  ==  WORKING) 

{ 

integrator_gain  +=  gov_i_gain  * 

(GOVERNOR_ENGINE_SPEED_SETTING  -  engine_speed); 
if  (integrator_gain  >  0.5) 
integrator_gain  =  0.5; 
else  if  (integrator_gain  <  -0.5) 
integrator_gain  =  -0.5; 

engine_power  +=  integrator_gain; 

} 

else  I*  Damaged  *! 

{ 

Integra  tor_gain  =  0.0; 
if  (engine_power  >  0.7) 
engine_power  =  0.7; 

} 


See  Appendix  C  for  a  complete  source  code  listing. 

3.6.5  Last_percent_shaft_speed 

The  variable  last_percent_shaft_speed  is  a  computed  variable  defining  the 
state  of  percent  of  powertrain  shaft  speed  from  the  last  frame. 

3.6.5.1  Initialization 

The  variable  last_percent_shaft_speed  is  initialized  during  execution  of  the 
CSU  enginejnit,  called  by  CSC  rwa_init.  Execution  of  the  CSU  engine_init 
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is  normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.6.  -  Engine  Initialization  Data  Array  for  a 
summary  of  the  initialization  variable. 


last_percent_shaft_speed  =  engine_init_data[  4]; 


3.6.5.2  Usage 

During  real-time  execution,  this  variable  is  recomputed  each  frame  of  CSC 
engine_simul. 

3.6.5.2.1  Algorithm 

Last_percent_shaft_speed  is  computed  by  assignment  of 
power  train_percent_shaft_speed  after  the  computation  of 
.powertrain_percent_shaft_speed  during  the  current  frame.  The  change  of 
powertrain  shaft  speed  is  compared  to  a  delta.  If  the  absolute  change  of  the 
pqwertrain  shaft  speed  is  greater  than  the  delta,  the  sound  for  the  rotor  is 
recomputed. 


if  (abs  (powertrain_percent_shaft_speed 
-  last_percent_shaft_speed)  >  0.025) 

{ 


I*  rotor  sounds  depend  on  RPMs 
*  (powertrain_percent_shaft_speed)  * ! 

temp_percent  =  max  (0.01,  powertrain_percent_shaft_speed); 
sound_make_cont_sound  (SOUND_OF_START_ROTOR, 
SOUND_OF_VARY_ROTOR, 
SOUND_OF_STOP_ROTOR,  temp_percent); 
last_percent_shaft_speed  =  powertrain_percent_shaft_speed; 

} 


See  Appendix  C  for  a  complete  source  code  listing. 

3.6.6  Last_percent_torque 

The  variable  last_percent_torque  is  a  computed  variable  defining  the  state  of 
percent  of  engine  torque  from  the  previous  frame. 

3.6.6.1  Initialization 

The  variable  last_percent_torque  is  initialized  during  execution  of  the  CSU 
engine_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  engine_init  is 
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normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  3.6.  -  Engine  Initialization  Data  Array  for  a  summary 
of  the  initialization  variable. 


last_percent_torque  =  engine_init_data[  5]; 


3.6.6.2  Usage 

During  real-time  execution,  this  variable  is  recomputed  each  frame  of  CSC 
engine_simul.  It  is  used  to  compute  sound  change  of  the  engine. 

3.6.6.2.1  Algorithm 

Last_percent_torque  is  computed  by  assignment  of  engine_percent_torque 
after  the  computation  of  .engine_percent_torque  during  the  current  frame. 
The  change  of  engine  torque  is  compared  to  a  delta.  If  the  absolute  change  of 
the  engine  torque  is  greater  than  this  delta,  the  sound  for  engine  is 
recomputed. 

if  (abs  (engine_percent_torque  -  last_percent_torque)  >  0.025) 

{ 

/*  engine  sounds  depend  on  torque  (engine_percent_torque)  */ 
temp_percent  =  max  (0.01,  engine_percent_torque); 
sound_make_cont_sound  (SOUND_OF_START_ENGINE, 
SOUND_OF_VARY_ENGINE, 
SOUND_OF_STOP_ENGINE,  temp_percent); 
last_percent_torque  =  engine_percent_torque; 

} 


See  Appendix  C  for  a  complete  soirrce  code  listing. 

3.6.7  Hours_of_flight 

The  variable  hours_of_flight  is  a  computed  variable  defining  the  current 
hours  of  flight. 

3. 6.7.1  Initialization 

The  variable  hours_of_flight  is  initialized  during  execution  of  the  CSU 
engine_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  engine_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.6.  -  Engine  Initialization  Data  Array  for  a 
summary  of  the  initialization  variable. 
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hour s_of_f light  =  engine_init_data[  6]; 

3.67.2  Usage 

During  real-time  execution,  this  variable  is  recomputed  each  frame  of  CSC 
engine_simul. 

3.6.7.2.1  Algorithm 

Hours_of_flight  is  computed  by  incrementing  the  current  hours_of_flight  by 
the  amount  of  time  each  frame  of  execution. 


hours_of_flight  +=  HOURS_PER_TICK; 


Sge  Appendix  C  for  a  complete  source  code  listing. 

3.7  Engine_stat_data 

This  data  array  consists  of  the  initial  values  for  flight  time,  engine  status, 
number  of  engines,  and  powertrain  damage  status. 

3.7.1  Minutes_of_£light 

The  variable  minutes_of_flight  is  a  computed  variable  defining  the  current 
minutes  of  flight. 

3.7.1.1  Initialization 

The  variable  minutes_of_flight  is  initialized  during  execution  of  the  CSU 
engine_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  engine_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.7.  -  Engine  Status  Data  Array  for  a  summary  of 
the  status  variable. 


minutes_of_flight  =  engine_stat_data[  0]; 


3.7.1.2  Usage 

During  real-time  execution,  this  variable  is  recomputed  each  frame  of  CSC 
engine_simul. 
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3.7.1.2.1  Algorithm 

Minutes_of_flight  is  computed  as  a  function  of  the  hours_of_flight. 

minutes_of_flight  =  (int)  (hours_of_flight  60); 

If  a  failure  has  occurred  to  the  engine  subsystem,  the  minutes_of_flight  is 
stored  in  the  variable  old_minutes_of_flight  for  use  in  the  next  frame. 


old_minutes_of_flight  =  minutes_of_flight; 


See  Appendix  C  for  a  complete  source  code  listing. 

3.7.2  Old_minutes_of_flight 

The  variable  minutes_of_flight  is  a  computed  variable  defining  the  current 
minutes  of  flight. 

3.7.2.1  Initialization 

The  variable  minutes_of_flight  is  initialized  during  execution  of  the  CSU 
engine_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  engine_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.7.  -  Engine  Status  Data  Array  for  a  summary  of 
the  status  variable. 


old_minutes_of_flight  =  engine_stat_data[  1]; 


3.7.2.2  Usage 

During  real-time  execution,  this  variable  is  recomputed  each  frame  of  CSC 
engine_simul. 

3.7.2.2.1  Algorithm 

If  a  failure  has  occurred  to  the  engine  subsystem,  the  minutes_of_flight  is 
stored  in  the  variable  old_minutes_of_flight  for  use  in  the  next  frame. 


old_minutes_of_flight  =  minutes_of_flight; 
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See  Appendix  C  for  a  complete  source  code  listing. 

3.7.3  Engine_status 

The  variable  engine_status  is  a  computed  variable  defining  the  current  state 
of  the  engine. 

3.7.3.1  Initialization 

The  variable  engine_status  is  initialized  during  execution  of  the  CSU 
enginejnit,  called  by  CSC  rwa_init.  Execution  of  the  CSU  enginejnit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.7.  -  Engine  Status  Data  Array  for  a  summary  of 
the  status  variable. 


engine_status  =  engine_stat_data[  2]; 

3.7.3.2  Usage 

During  real-time  execution,  this  variable  is  recomputed  each  frame  of  CSC 
engine_simul. 

3.7.3.2.1  Algorithm 

If  the  engine_status  is  WORKING,  the  integrator_gain  and  engine_power  are 
computed. 
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if  (engine_status  ==  WORKING) 

{ 

Integra tor_gain  +=  gov_i_gain 

(GOVERNOR_ENGINE_SPEED_SETTING  -  engine_speed); 
if  (integrator_gain  >  0.5) 
integrator_gain  =  0.5; 
else  if  (integrator_gain  <  -0.5) 
integrator_gain  =  -0.5; 

engine_power  +=  integrator_gain; 

} 

else  I*  Damaged  */ 

{ 

integrator_gain  =  0.0; 
if  (engine_power  >0.7) 
engine_power  =  0.7; 

} 

(  i 

If  the  engine_status  is  WORKING,  engine_speed  is  computed. 


if  (engine_status  ==  WORKING) 

engine_speed  +=  (engine_drive_torque  -  engine_load_torque) 
/  POWERTRAIN_INERTIA; 


If  the  engine_status  is  BROKEN,  sound  is  halted. 


if  (engine_status  ==  BROKEN)/’^  crippled  condition  *! 

{ 

sound_stop_cont_sound  (SOUND_OF_STOP_ENGINE, 
SOUND_OF_VARY_ENGINE); 

sound_stop_cont_sound  (SOUND_OF_STOP_ROTOR, 
SOUND_OF_V  ARY_ROTOR) ; 

fuel_flow  *=  50.0;  I*  fuel  leak  *! 

} 


If  a  failure  has  broken  the  engine  subsystem,  engine_status  is  set  to  BROKEN. 
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void  engine_break_engine  () 

{ 

engine_status  =  BROKEN; 
engine_speed  =  0.0; 
number_of_engines  =  1; 


If  the  engine  subsystem  has  been  repaired,  engine_status  is  set  to  WORKING. 


void  engine_repair_engine  () 

{ 

engine_repair_engine_oil  (); 
engine_status  =  WORKING; 
number_of_engines  =  2; 


See  Appendix  C  for  a  complete  source  code  listing. 

3.7.4  Starting_engine 

The  variable  starting_engine  is  a  computed  Boolean  defining  the  current 
state  of  the  engine  in  a  starting  mode. 

3.7.4.1  Initialization 

The  variable  starting_engine  is  initialized  during  execution  of  the  CSU 
enginejnit,  called  by  CSC  rwa_init.  Execution  of  the  CSU  enginejnit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.7.  -  Engine  Status  Data  Array  for  a  summary  of 
the  status  variable. 


starting_engine  =  engine_stat_data[  3]; 


3.7.4.2  Usage 

During  real-time  execution,  this  variable  is  recomputed  each  frame  of  CSC 
engine_simul. 
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3.7.4.2.1  Algorithm 

If  the  engine  is  starting,  engine_percent_torque  is  limited  to  .01  until  it 
exceeds  the  delta,  at  which  time  the  starting_engine  flag  is  set  to  FALSE. 


if  (starting_engine) 

{ 

if  (engine_percent_torque  -  .01  <  .0001)  I*  within  a  delta  * ! 

starting_engine  =  FALSE; 
else 

engine_percent_torque  =  .01; 

} 


See  Appendix  C  for  a  complete  source  code  listing. 

3.7.5  Number_of_engines  . 

The  variable  starting_engine  is  a  computed  Boolean  defining  the  current 
state  of  the  engine  in  a  starting  mode. 

3.7.5.1  Initialization 

The  variable  starting_engine  is  initialized  during  execution  of  the  CSU 
engine_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  engine_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.7.  -  Engine  Status  Data  Array  for  a  summary  of 
the  status  variable. 


number_of_engines  =  engine_stat_data[  4]; 

3.7.5.2  Usage 

During  real-time  execution,  this  variable  is  recomputed  each  frame  of  CSC 
engine_simul. 

3.7.5.2.1  Algorithm 

If  the  engine  subsystem  has  been  broken,  the  number_of_engines  is  reset  to  1 
by  a  call  to  CSC  engine_break_engine. 
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void  engine_break_engine  () 

{ 

engine_status  =  BROKEN; 
engine_speed  =  0.0; 
number_of_engines  =  1; 


If  the  engine  subsystem  has  been  repaired,  the  number_of_engines  is  reset  to 
2  by  a  call  to  CSC  engine_repair_engine. 


void  engine_repair_engine  () 

{ 

engine_repair_engine_oil  (); 
engine_status  =  WORKING; 
number_of_engines  =  2; 

} 

t 


The  number_of_engines  is  used  to  compute  the  engine_drive_torque. 


engine_drive_torque  =  engine_power  *  number_of_engines  * 

(ENGINE_TORQUE_INTERCEPT  -  ENGINE_TORQUE_SLOPE  * 
engine_speed); 


The  number_of_engines  is  used  to  compute  the  engine_percent_torque. 


engine_percent_torque  =  engine_drive_torque  / 

(MAX_ENGINE_TORQUE  *  number_of_engines); 


See  Appendix  C  for  a  complete  source  code  listing. 

3.7.6  Engine_is_damaged 

The  variable  engine_is_damaged  is  a  computed  Boolean  defining  the  current 
state  of  the  engine  damage. 
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3.7.6.1  Initialization 

The  variable  engine_is_damaged  is  initialized  during  execution  of  the  CSU 
engine_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  engine_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.7.  -  Engine  Status  Data  Array  for  a  summary  of 
the  status  variable. 


enginejs_damaged  =  engine_stat_data[  5]; 


3.7.6.2  Usage 

During  real-time  execution,  this  variable  is  recomputed  each  frame  of  CSC 
engine_simul. 

3.7.6.2.1  Algorithm 

If' engine  oil  is  damaged,  engine_is_damaged  is  set  to  TRUE  by  a  call  to  CSC 
engine_damage_engine_oil. 


void  engine_damage_engine_oil  () 

{ 

#if  DO_CFAIL 

controls_start_failure_lamp_flashing  (MASTER_CAUTION); 
controls_start_failure_lamp_flashing  (ENGINE_FAILURE); 
#endif 

engine_is_damaged  =  TRUE; 

} 


If  engine  oil  is  repaired,  engine_is_damaged  is  set  to  FALSE  by  a  call  to  CSC 
engine_repair_engine_oil. 


void  engine_repair_engine_oil  () 

{ 

#if  DO_CFAIL 

controls_failure_lamp_off  (ENGINE_FAILURE); 
engine_is_damaged  =  FALSE; 

#endif 

i) 
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See  Appendix  C  for  a  conaplete  source  code  listing. 

3.7.7  Transmission_is_damaged 

The  variable  transmission_is_damaged  is  a  computed  Boolean  defining  the 
current  state  of  the  transmission  damage. 

3.7,7.1  Initialization 

The  variable  transmission_is_damaged  is  initialized  during  execution  of  the 
CSU  enginejnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU  enginejnit 
is  normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.7.  -  Engine  Status  Data  Array  for  a  summary  of 
the  status  variable. 


transmission_is_damaged  =  engine_stat_data[  6]; 


i.in.l  Usage 

During  real-time  execution,  this  variable  is  recomputed  each  frame  of  CSC 
engine_simul. 

3.7.7.2.1  Algorithm 

If  engine  transmission  filter  is  damaged,  transmissionjs.damaged  is  set  to 
TRUE  by  a  call  to  CSC  engine_damage_transmission_filter. 


void  engine_damage_transmission_filter  () 

{ 

#if  DO_SFAIL 

controls_start_failure_lamp_flashing  (MASTER_CAUTION); 
controls_start_failure_lamp_flashing  (TRANSMISSION_FAILURE); 
transmission_is_damaged  =  TRUE; 

#endif 

} 


If  engine  transmission  filter  is  repaired,  transmissionJs_damaged  is  set  to 
FALSE  by  a  call  to  CSC  engine_repair_transmission_filter. 
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void  engine_repair_transmission_filter  () 

{ 

#if  DO_SFAIL 

con  trols_f ailure_lamp_of f  (TRAN SMISSION_F AILURE); 
transmission_is_damaged  =  FALSE; 

#endif 


See  Appendix  C  for  a  complete  source  code  listing. 

3.8  Kinemat_data 

This  data  array  consists  of  kinematics  constants  and  limits  for  the  vehicle  and 
its  control. 

3.8.1  GRAV_CONSTANT 

GjRAV_CONSTANT  is  a  constant  defining  the  gravitational  constant. 

3.8.1.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.8.  -  Kinematics 
Data  Array  for  a  summary  of  the  constant. 


#define  GRAV_CONSTANT  kinemat_data[  0] 


3.8.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.8.1.2.1  Algorithm 

The  constant  is  used  to  compute  g_force  during  execution  of  CSU 
veh_spec_kinematics_simul. 

g_force  =  gravity[Z]  +  (true_air speed  *  ang_vel[X]  /  GRAV_CONSTANT); 


See  APPENDIX  D  for  a  complete  source  code  listing. 
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3.8.2  SIN_AOA_LIMIT 

SIN_AOA_LIMIT  is  a  constant  defining  the  sine  of  the  angle_of_attack  limit. 

3.8.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_iniL  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.8.  -  Kinematics 
Data  Array  for  a  summary  of  the  constant. 


#define  SIN_AOA_LIMIT  kinemat_data[  11 


3.8.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

318.2.2.1  Algorithm 

The  constant  is  not  used  for  any  current  computations. 

See  APPENDIX  D  for  a  complete  source  code  listing. 

3.8.3  COS_AOA_LIMIT 

COS_AOA_LIMIT  is  a  constant  defining  the  cosine  of  the  angle_of_attack 
limit. 

3.8.3.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.8.  -  Kinematics 
Data  Array  for  a  summary  of  the  constant. 

#define  COS_AOA_LIMIT  kinemat_data[  2] 


3.8.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.8.3.2.1  Algorithm 

The  constant  is  not  used  for  any  current  computations. 

See  APPENDIX  D  for  a  complete  source  code  listing. 

3.8.4  SIN_YAW_LIMIT 

SIN_YAW_LIMIT  is  a  constant  defining  the  sine  of  the  yaw  limit. 

3.8.4.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU  ' 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.8.  -  Kinematics 
Data  Array  for  a  summary  of  the  constant. 

#define  SIN_YAW_LIMIT  kinemat_data[  3] 


3.8.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.8.4.2.1  Algorithm 

The  constant  is  not  used  for  any  current  computations. 

See  APPENDIX  D  for  a  complete  source  code  listing. 

3.8.5  COS_YAW_LIMIT 

COS_YAW_LIMIT  is  a  constant  defining  the  cosine  of  the  yaw  limit. 

3.8.5.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.8.  -  Kinematics 
Data  Array  for  a  summary  of  the  constant. 

#define  COS_YAW_LIMIT  kinemat_data[  4] 
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3.8.5.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.8.5.2.1  Algorithm 

The  constant  is  not  used  for  any  current  computations. 

See  APPENDIX  D  for  a  complete  source  code  listing. 

3.8.6  DISPLAY_SPEED_LIMIT 

DISPLAY_SPEED_LIMIT  is  a  constant  defining  the  lower  limit  of  the 
displayed  speed. 

3.8.6.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.8.  -  Kinematics 
Data  Array  for  a  summary  of  the  constant. 

#define  DISPLAY_SPEED_LIMIT  kinemat_data[  5] 


3.8.6.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.8.6.2.1  Algorithm 

The  constant  is  used  to  control  computation  of  the  velocity _pitch. 


if  (true_air speed  >=  DISPLAY_SPEED_LIMrr) 
velocity_pitch  =  asin  (vertical_speed); 
else 

velocity  _pitch  =  0.0; 


The  constant  is  used  to  control  computation  of  the  normalized  velocity  vector. 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


REAL  ’^kinematics_get_normalized_velocity_vector  () 

{ 

if  (true_airspeed  >  DISPLAY_SPEED_LIMIT) 
return  (norm_vel); 
else  if  (norm_vel[Y]  >=  0.0) 
return  (pos_unit_vel); 
else 

return  (neg_unit_vel); 

;} 


See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9  Kinemat_init_data 

This  data  array  consists  of  initial  values  for  kinematics  variables  including 
velocity,  angle-of-attack,  pitch,  altitude,  heading,  and  g-force. 

3.9.1  Pos_unit_vel 

Pos_unit_vel  is  an  array  defining  the  positive  unit  velocity  vector. 

3.9.1.1  Initialization 

The  array  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  suimnary  of  the  variable  data. 


pos_unit_vel[Y]  =  kinemat_init_data[  1]; 
pos_unit_vel[Z]  =  kinemat_init_data[  2]; 


3.9.1.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 

3.9.1.2.1  Algorithm 

The  array  is  returned  as  the  normalized  velocity  vector  under  certain 
conditions. 
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REAL  *kinematics_get_normalized_velocity_vector  () 

{ 

if  (true_airspeed  >  DISPLAY_SPEED_LIMIT) 
return  (norm_vel); 
else  if  (norm_vel[Y]  >=  0.0) 
return  (pos_unit_vel); 
else 

return  (neg_unit_vel); 


See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.2  Neg_unit_vel 

Neg_unit_vel  is  an  array  defining  the  negative  unit  velocity  vector. 

3.9.2.1  Initialization 

The  array  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 


neg_unit_vel[X]  = 
neg_unit_vel[Y]  = 
neg_unit_vel[Z]  = 


kinemat_init_data[  3]; 
kinemat_init_data[  4]; 
kinemat_init_data[  5]; 


3.9.2.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 

3.9.2.2.1  Algorithm 

The  array  is  returned  as  the  normalized  velocity  vector  under  certain 
conditions. 
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REAL  =^kinematics_get_normalized_velocity_vector  () 

{ 

if  (true_airspeed  >  DISPLAY_SPEED_LIMIT) 
return  (norm_vel); 
else  if  (norm_vel[Y]  >=  0.0) 
return  (pos_unit_vel); 
else 

return  (neg_unit_vel); 


See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.3  Sin_aoa 

Sin_aoa  is  a  variable  defining  the  sine  of  the  angle-of-attack. 

3.9.3.1  Initialization 

xAe  variable  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 


sin_aoa  =  kinemat_init_data[  6]; 


3.9.3.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.9.3.2.1  Algorithm 

The  value  of  sin_aoa  is  set  based  on  the  value  of  the  'Z'  component  of  the 
normalized  velocity  vector. 
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if  (norm_vel[Z]  -  1.0  >  -E_NANO) 

{ 

sin_aoa  =  -1.0; 
cos_aoa  =  0.0; 
sin_yaw  =  0.0; 
cos_yaw  =  1.0; 

} 

else  if  (norm_vel[Z]  +  1.0  <  E_NANO) 

{ 

sin_aoa  =  1.0; 
cos_aoa  =  0.0; 
sin_yaw  =  0.0; 
cos_yaw  =  1.0; 

} 

else 

{ 

sin_aoa  =  -norm_vel[Z]; 

cos_aoa  =  sqrt  (norm_vel[X]  *  norm_vel[X]  +  norm_vel[Y]  * 
.  norm_vel[Y]); 

sin_yaw  =  norm_vel[X]  /  cos_aoa; 
cos_yaw  =  norin_vel[Y]  /  cos_aoa; 

} 


Sin_aoa  is  used  to  compute  a  component  of  the  velocity_to_body  matrix. 


velocity_to_body[l][2]  =  -sin_aoa; 


See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.4  Cos_aoa 

Cos_aoa  is  a  variable  defining  the  cosine  of  the  angle-of-attack. 

3.9.4.1  Initialization 

The  variable  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 
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3.9.4.2  Usage 


During  real-time  execution,  this  variable  is  recomputed. 


3.9.4.2.1  Algorithm 

The  value  of  cos_aoa  is  set  based  on  the  value  of  the  'Z'  component  of  the 
normalized  velocity  vector. 


Cos_aoa  is  used  to  compute  a  components  of  the  velocity_to_body  matrix, 
roll  and  heading. 
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temp  =  cos_aoa; 


velocity_to_body[l][0]  =  -velocity_to_body[0][l]  *  temp; 

velocity_to_body[l][l]  =  velocity_to_body[0][0]  temp; 


temp  =  sqrt  (body_to_world[l][0]  body_to_world[l][0]  + 
body_to_world[l][l]  *  body_to_world[l][l]); 
if  (temp  <  E_NANO) 

{ 

roll  =  0.0; 
heading  =  0.0; 

} 

else 

{ 

temp2  =  (body_to_world[0][0]  body_to_world[l][l]  - 

body_to_world[0][l]  *  body_to_world[l][0])  /  temp; 
if  (temp2  >  1.0)  temp2  =  1.0; 
roll  =  acos  (temp2); 

if  (body_to_world[l][l]  *body_to_world[2][0]  - 

body_to_world[l]  [0]  *body_to_world[2][l]  <  0.0) 
roll  =  -roll; 

if  (body_to_world[l][0]  >=  0.0) 

heading  =  acos  (body_to_world[l][l]  /  temp); 
else 

heading  =  acos  (-body_to_world[l][l]  /  temp)  +  PI; 


See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.5  Sin_yaw 

Sin_yaw  is  a  variable  defining  the  sine  of  the  yaw  angle. 

3.9.5.1  Initialization 

The  variable  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 
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3.9.5.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 


3.9.5.2.1  Algorithm 

The  value  of  sin_yaw  is  set  based  on  the  value  of  the  'Z'  component  of  the 
normalized  velocity  vector. 


The  value  of  sin_yaw  is  used  to  compute  the  value  of  a  component  of  the 
velocity_to_body  matrix. 


See  APPENDIX  D  for  a  complete  source  code  listing. 
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3.9.6  Cos_yaw 

Cos_yaw  is  a  variable  defining  the  cosine  of  the  yaw  angle. 

3.9.6.1  Initialization 

The  variable  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 


cos_yaw  =  kinemat_init_data[  9]; 


3.9.6.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.9.6.2.1  Algorithm 

The  value  of  cos_yaw  is  set  based  on  the  value  of  the  'Z'  component  of  the 
normalized  velocity  vector. 


if  (norm_vel[Z]  - 1.0  >  -E_NANO) 

{ 

sin_aoa  =  -1.0; 
cos_aoa  =  0.0; 
sin_yaw  =  0.0; 
cos_yaw  =  1.0; 

} 

else  if  (norm_vel[Z]  +  1.0  <  E_NANO) 

{ 

sin_aoa  =  1.0; 
cos_aoa  =  0.0; 
sin_yaw  =  0.0; 
cos_yaw  =  1.0; 

} 


-159- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 

else 

{ 

sin_aoa  =  -norm_vel[Z]; 

cos_aoa  =  sqrt  (norm_vel[X]  *  norin_vel[X]  +  norm_vel[Y]  * 
norm_vel[Y]); 

sin_yaw  =  norin_vel[X]  /  cos_aoa; 
cos_yaw  =  norm_vel[Y]  /  cos_aoa; 

} 

The  value  of  cos_yaw  is  used  to  compute  the  value  of  a  component  of  the 
velocity_to_body  matrix. 

velocity_to_body[0][0]  =  cos_yaw; 

See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.7  Altitude 

Altitude  is  a  variable  defining  the  altitude  above  mean  sea  level,  the  database 
datum. 

3.9.7.1  Initialization 

The  variable  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 

altitude  =  kinemat_init_data[10]; 

3.9.7.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.9.7.2.1  Algorithm 

The  value  of  altitude  is  set  by  assignment  of  the  'Z'  component  of  the 
position  vector. 
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altitude  =  position  [Z]; 

If  the  value  of  altitude  is  negative,  the  altitude  is  limited  to  0.0. 


if  (altitude  <  0.0) 
altitude  =  0.0; 


See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.8  Body_pitch 

Body_pitch  is  a  variable  defining  the  angle  of  body  pitch. 

3.9.8.1  Initialization 

T^ie  variable  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 


body_pitch  =  kinemat_init_data[ll]; 

3.9.8.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.9.8.2.1  Algorithm 

The  value  of  body_pitch  is  computed  as  the  arcsine  of  a  component  of  the 
body_to_world  matrix. 

body_pitch  =  asin  (body_to_world[l][2]); 

External  access  to  the  body_pitch  is  achieved  through  a  call  to  the  CSC 
kinematics_get_body_pitch.  The  value  return  includes  an  offset  constant 
that  allows  for  the  adjustment  of  the  body_pitch  reference. 
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REAL  kinematics_get_body_pitch  () 

{ 

return  (body_pitch  +  body_pitch_offset); 

} 


See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.9  Body_pitch_offset 

Body_pitch_offset  is  a  constant  defining  the  offset  angle  of  body  pitch.  This 
offset  allows  for  the  adjustment  of  the  body_pitch  reference. 

3.9.9.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 


body_pitch_offset  =  kinemat_init_data[12]; 


3.9.9.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.10  Velocity _pitch 

Velocity_pitch  is  a  variable  defining  the  cosine  of  the  angle-of-attack. 

3.9.10.1  Initialization 

The  variable  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 


velocity  _pitch  =  kinemat_init_data[13]; 
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3.9.10,2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.9.10.2.1  Algorithm 

The  value  of  velocity _pitch  is  computed  as  the  arcsine  of  the  vertical_speed. 
If  the  true_airspeed  is  small,  then  the  velocity_pitch  is  set  to  0.0. 


if  (true_airspeed  >=  DISPLAY_SPEED_LIMIT) 
velocity _pitch  =  asin  (vertical_speed); 
else 

velocity_pitch  =  0.0; 


See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.11  Roll 

Roll  is  a  variable  defining  the  roll  angle  of  the  vehicle. 

3.9.11.1  Initialization 

The  variable  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 


roll  =  kinemat_init_data[14]; 


3.9.11.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.9.11.2.1  Algorithm 

The  value  of  roll  is  computed  from  components  of  the  body_to_world 
matrix. 
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temp  =  sqrt  (body_to_world[l][0]  *  body_to_world[l][0]  + 
body_to_world[l][l]  body_to_world[l ][!]); 


if  (temp  <  E_NANO) 

{ 

roll  =  0.0; 
heading  =  0.0; 

} 

else 

^  temp2  =  (body_to_world[0][0]  body_to_world[l][l]  - 

body_to_world[0][l]  =^body_to_world[l][0])  /  temp; 

if  (temp2  >1.0)  temp2  =  1.0; 
roll  =  acos  (temp2); 

if  (body_to_world[l][l]  ’'body_to_world[2][0]  - 

body_to_world[l][0]  *  body_to_world[2][l]  <  0.0) 
roll  =  -roll; 

'  if  (body_to_world[l][0]  >=  0.0) 

heading  =  acos  (body_to_world[l][l]  /  temp); 
else 

heading  =  acos  (-body_to_world[l][l]  /  temp)  +  PI; 

} 


See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.12  Heading 

Heading  is  a  variable  defining  the  heading  angle  the  vehicle. 

3.9.12.1  Initialization 

The  variable  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 


heading  =  kinemat_init_data[15]; 
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3.9.12.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.9.12.2.1  Algorithm 

The  value  of  heading  is  computed  from  components  of  the  body_to_world 
matrix. 


temp  =  sqrt  (body_to_world[l][0]  *  body_to_world[l][0]  + 
body_to_world[l][l]  *  body_to_world[l][l]); 


if  (temp  <  E_NANO) 

{ 

roU  =  0.0; 
heading  =  0.0; 

'else 

{ 

temp2  =  (body_to_world[0][0]  *body_to_world[l][l]  - 

body_to_world[0][l]  *  body_to_world[l][0])  /  temp; 
if  (temp2  >  1.0)  temp2  =  1.0; 
roll  =  acos  (temp2); 

if  (body_to_world[l][l]  ’^body_to_world[2][0l  - 

body_to_world[l]  [0]  *  body_to_world[2l[l]  <  0.0) 
roll  =  -roll; 

if  (body_to_world[l][0]  >=  0.0) 

heading  =  acos  (body_to_world[l][l]  /  temp); 
else 

heading  =  acos  (-body_to_world[l][l]  /  temp)  +  PI; 


See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.13  True_airspeed 

True_airspeed  is  a  variable  defining  the  true  airspeed  of  the  vehicle. 
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3.9.13.1  Initialization 

The  variable  is  initialized  during  execution  of  the  CSU 
veh  spec  kinematicsjnit,  called  by  CSC  rwajnit.  Execution  of  the  CSU 
veh  spec  kinematicsjnit  is  normally  done  only  once  during  CS 
Litfalization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 


true_airspeed  =  kinematjnit_data[16]. 


3.9.13.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 


3.9.13.2.1  Algorithm 

The  value  of  true_airspeed  is  computed  from  the  velocity  vector. 

I 

true_airspeed  =  sqrt  (velocityfX]  velocityfX]  +  velocity[Y]  velocity[Y] 
+  velocity[Z]  *  velocity[Z]); 

True_airspeed  is  used  to  compute  indicated_airspeed. 

indicated_airspeed  =  true_airspeed  *  sqrt  (air_density  (altitude)  / 
air_density(0.0)); 

True_airspeed  is  used  to  compute  the  normalized  velocity  vector. 
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if  (true_airspeed  <  E_MILLI) 

{ 

norm_vel[X]  =  0.0; 
norm_vel[Y]  =  1.0; 
norm_vel[Z]  =  0.0; 

} 

else 

{ 

norm_vel[X]  =  velocity[X]  /  true_airspeed; 
norm_vel[Y]  =  velocity [Y]  /-  true_airspeed; 
norm_vel[Z]  =  velocity  [Z]  /  true_airspeed; 

} 


True_airspeed  is  used  to  compute  g_force. 


g_force  =  gravity[Z]  +  (true_airspeed  *  ang_vel[X]  /  GRAV_CONSTANT); 

t 

True_airspeed  is  used  to  control  computation  of  velocity _pitch. 


if  (true_airspeed  >=  DISPLAY_SPEED_LIMIT) 
velocity_pitch  =  asin  (vertical_speed); 
else 

velocity  _pitch  =  0.0; 

When  access  externally  to  the  normalized  velocity  vector  is  requested, 
true_airspeed  controls  the  value  of  the  returned  variable. 

REAL  ’^kinematics_get_normalized_velocity_vector  () 

{ 

if  (true_airspeed  >  DISPLAY_SPEED_LIMn’) 
return  (norm_vel); 
else  if  (norm_vel[Y]  >=  0.0) 
return  (pos_unit_vel); 
else 

return  (neg_unit_vel); 


-167- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.14  Indicated_airspeed 

Indicated_airspeed  is  a  variable  defining  the  indicated  airspeed  of  the  vehicle 


3.9.14.1  Initialization 

The  variable  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematicsJniL  called  by  CSC  rwajnit.  Executiori  of  the  CSU 
veh  spec  kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 


indicated_airspeed  =  kinemat_init_data[17]; 


3.9.14.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.9.14.2.1  Algorithm 

The  value  of  indicated_airspeed  is  computed  from  the  true_airspeed  and 
corrected  for  altitude. 

indicated_airspeed  =  true_airspeed  *  sqrt  (air_density  (altitude)  / 
air_density(0.0)); 

See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.15  G_force 

G_force  is  a  variable  defining  the  "g"  force  exerted  on  the  vehicle. 

3.9.15.1  Initialization 

The  variable  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematicsjnit,  called  by  CSC  rwajnit.  Executiori  of  the  CSU 
veh  spec_kinematicsjnit  is  normally  done  only  once  during  CSUi 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 
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g_force  =  kinemat_init_data[18]; 

3.9.15.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.9.15.2.1  Algorithm 

The  value  of  g_force  is  set  computed  from  the  true_airspeed  and  angular 
velocity. 

g_force  =  gravity[Z]  +  (true_air speed  *  ang_vel[X]  /  GRAV_CONSTANT); 

See  APPENDIX  D  for  a  complete  source  code  listing. 

3,9.16  Vertical_speed 

Vertical_speed  is  a  variable  defining  the  vertical  speed  of  the  vehicle. 

3.9.16.1  Initialization 

The  variable  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 

vertical_speed  =  kinemat_init_data[19]; 


3.9.16.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.9.16.2.1  Algorithm 

The  value  of  vertical_speed  is  computed  from  the  normalized  velocity  vector 
and  gravity,  and  adjusted  using  the  true_airspeed. 
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vertical_speed  =  vec_dot_prod  (norm_vel,  gravity); 
vertical_speed  true_airspeed; 


Vertical_speed  is  used  to  compute  velocity_pitch. 


if  (true_airspeed  >=  DISPLAY_SPEED_LIMIT) 
velocity_pitch  =  asin  (vertical_speed); 
else 

velocity_pitch  =  0.0; 


See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.17  Gravity 

f 

Gravity  is  a  vector  defining  the  gravity  components  of  the  vehicle. 

3.9.17.1  Initialization 

The  variable  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 


gravity  [X]  = 

kinema  t_ini  t_da  ta  [20]; 

gravity  [Y]  = 

kinema  t_ini  t_da  ta  [21  ]; 

gravity  [Z]  = 

kinema  t_ini  t_da  ta  [22] ; 

3.9.17.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 

3.9.17.2.1  Algorithm 

The  value  of  gravity  is  assigned  from  the  components  of  the  body_to_world 
matrix. 
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gravity  [X]  =  body_to_world[0][2]; 
gravity  [Y]  =  body_to_world[l][2]; 
gravity  [Z]  =  body_to_world[2][2]; 


The  'Z'  component  of  the  gravity  vector  is  used  to  compute  gjorce. 


g_force  =  gravity[Z]  +  (true_air speed  *  ang_vel[X]  /  GRAV_CONSTANT); 


The  value  of  vertical_speed  is  computed  from  the  normalized  velocity  vector 
and  gravity,  and  adjusted  using  the  true_airspeed. 


vertical_speed  =  vec_dot_prod  (norm_vel,  gravity); 


See  APPENDIX  D  for  a  complete  source  code  listing. 

3.9.18  Norm_vel 

Norm_vel  is  a  vector  defining  the  normalized  velocity  vector. 

3.9.18.1  Initialization 

The  variable  is  initialized  during  execution  of  the  CSU 
veh_spec_kinematics_init,  called  by  CSC  rwa_init.  Execution  of  the  CSU 
veh_spec_kinematics_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.9.  -  Kinematics 
Initialization  Data  Array  for  a  summary  of  the  variable  data. 


norm  vel[X]  = 

kinemat_init_data[23]; 

norm  vel[Y]  = 

kinemat_init_data[24]; 

norm_vel[Z]  = 

kinemat_init_data[25]; 

3.9.18.2  Usage 

During  real-time  execution,  this  variable  is  recomputed. 
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3.9.18.2.1  Algorithm 

The  value  of  norm_vel  vector  is  computed  from  the  true_airspeed  and 
velocity  vector. 


if  (true_airspeed  <  E_MILLI) 

{ 

norm_vel[X]  =  0.0; 
norm_vel[Y]  =  1.0; 
norm_vel[Z]  =  0.0; 

} 

else 

{ 

norm_vel[X]  =  velocity[X]  /  true_airspeed; 
norm_vel[Y]  =  velocity[Y]  /  true_airspeed; 
norm_vel[Z]  =  velocity[Z]  /  true_airspeed; 

} 

I  _ 

The  norm_vel  is  used  to  compute  and  control  computation  of  the  sin_aoa, 
cos_aoa,  sin_yaw,  and  cos_yaw. 


if  (norm_vel[Z]  - 1.0  >  -E_NANO) 

{ 

sin_aoa  =  -1.0; 
cos_aoa  =  0.0; 
sin_yaw  =  0.0; 
cos_yaw  =  1.0; 

} 

else  if  (norm_vel[Z]  +  1.0  <  E_NANO) 

{ 

sin_aoa  =  1.0; 
cos_aoa  =  0.0; 
sin_yaw  =  0.0; 
cos_yaw  =  1.0; 

}  _ 
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else 

{ 

sin_aoa  = -norin_vel[Z]; 

cos_aoa  =  sqrt  (norm_vel[X]  *  norin_vel[X]  +  norm_vel[Y] 
norm_vel[Y]); 

sin_yaw  =  norm_vel[X]  /  cos_aoa; 
cos_yaw  =  norm_vel[Y]  /  cos_aoa; 

} 


The  value  of  vertical_speed  is  computed  from  the  normalized  velocity  vector 
and  gravity,  and  adjusted  using  the  true_airspeed. 


vertical_speed  =  vec_dot_prod  (norm_vel,  gravity); 


See  APPENDIX  D  for  a  complete  source  code  listing. 

S’.IO  Hellfr_miss_char 

This  data  array  consists  of  characteristics  and  parameters  describing  a  Hellfire 
missile  system  and  its  performance  constraints. 

3.10.1  HELLFIRE_ARM_TIME 

HELLFIRE_ARM_TIME  is  a  constant  defining  the  hellfire  missile  arm  time 
delay  before  firing  in  ticks. 

3.10.1.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.10.  -  Hellfire  Missile  Characteristics  Data  Array 
for  a  summary  of  the  constants  data. 


#define  HELLFIKE_ARM_TIME  hellfr_miss_char[  0] 


3.10.1.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 
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3.10.1.2.1  Algorithm 

HELLFIRE_ARM_TIME  is  used  to  control  computation  of  the  missile  flyout 
path  by  a  call  to  the  CSC  missile_hellfire_fly. 


/V 

*  If  the  missile  is  not  armed,  fly  in  a  search  trajectory;  otherwise,  fly 
in  a  targeted  trajectory. 

/V 

if(  max_range_limit  >  0  && 

kinematics_range_squared  (veh_kinematics,  mptr->location)  > 
max_range_squared  ) 
missile_target_groimd(  mptr  ); 
else  if  (time  <  HELLnRE_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 
COS_LOCK,  COS_TERM,  COS_LOSE); 

,else 

missile_target_agm  (mptr,  target_location,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN.LOCK,  COS_LOCK,  COS_TERM,  COS.LOSE); 


See  APPENDIX  G  for  a  complete  source  code  listing. 

3.10.2  HELLFIRE_BURNOUT_TIME 

HELLFIRE_BURNOUT_TIME  is  a  constant  defining  the  time  of  powered 
flight  for  hellfire  missile  in  ticks. 

3.10.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.10.  -  Hellfire  Missile  Characteristics  Data  Array 
for  a  summary  of  the  constants  data. 


#define  HELLnRE_BURNOUT_TIME  hellfr_miss_char[  1] 


3.10.2.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 
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3.10.2.2.1  Algorithm 

HELLFIRE_BURNOUT_TIME  is  used  to  control  computation  of  the  missile 
flyout  speed  by  a  call  to  the  CSC  missile_hellfire_fly. 


time  =  mptr->time; 

/V 

Find  the  current  missile  speed  .  .  ..  The  equations  used  are  different 
before  and  after  motor  burnout. 

/V 

if  (time  <  HELLHRE_BURNOUT_TIME) 

mptr->speed  =  mptr->init_speed  +  (speed_factor  * 
(missile_util_eval_poly  (HELLFIRE_BURN_SPEED_DEG, 

hellfire_burn_speed_coeff,  time)  )); 

} 

else 

'  mptr->speed  =  mptr->init_speed  +  (speed_factor  * 

(missile_util_eval_poly  (HELLFIRE_COAST_SPEED_DEG, 

hellfire_coast_speed_coeff,  time)  )); 

} 


See  APPENDIX  G  for  a  complete  source  code  listing. 

3.10.3  HELLFIRE_MAX_FLIGHT_TIME 

HELLnRE_MAX_FLIGHT_TIME  is  a  constant  defining  the  maximum  flight 
time  for  the  hellfire  missile  assumed  in  ticks. 

3.10.3.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.10.  -  Hellfire  Missile  Characteristics  Data  Array 
for  a  summary  of  the  constants  data. 


#define  HELLnRE_MAX_FLIGHT_TIME  hellfr_miss_char[  2] 
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3.10.3.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.10.3.2.1  Algorithm 

HELLFIRE_MAX_FLIGHT_TIME  is  used  to  initialize  the  maximum  flight 
time  for  an  individual  hellfire  missile  by  a  call  to  the  CSU 
missile_hellfire_init. 


mptr->max_flight_time  =  HELLFIRE_MAX_FLIGHT_TIME; 


If  not  defined,  the  max_flight_time  is  set  to  the  time-of-flight  to  the 
maximum  range  limit  plus  one  by  a  call  to  the  CSC  missile_hellfire_fire. 


#i^def  notdeff 

if(  max_range_limit  >  0.0  ) 
mptr->max_flight_time  = 

1.0  +  missile_hellfire_calc_tof(  max_range_limit ); 

#endif 


See  APPENDIX  G  for  a  complete  source  code  listing. 

3.10.4  SPEED_0 

SPEED_0  is  a  constant  defining  the  reference  turn  speed  used  to  compute  the 
ratio  for  the  maximum  turn  angle. 

3.10.4.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.10.  -  Hellfire  Missile  Characteristics  Data  Array 
for  a  summary  of  the  constants  data. 


#define  SPEED_0  hellfr_miss_char[  3] 
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3.10.4.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.10.4.2.1  Algorithm 

SPEED_0  is  used  to  compute  the  maximum  turn  angle  for  an  individual 
hellfire  missile  by  a  call  to  the  CSC  missile_hellfire_fly. 

mptr->cos_max_turn[0]  =  cos  (sqrt  (mptr->speed  /  SPEED_0)  THETA_0); 

See  APPENDIX  G  for  a  complete  source  code  listing. 

3.10.5  THETA_0 

THETA_0  is  a  constant  defining  the  reference  maximum  turn  angle  which  is 
scaled  for  speed. 

I 

3.10.5.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.10.  -  Hellfire  Missile  Characteristics  Data  Array 
for  a  summary  of  the  constants  data. 

#define  THETA_0  hellfr_miss_char[  4] 

3.10.5.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.10.5.2.1  Algorithm 

THETA_0  is  used  to  compute  the  maximum  turn  angle  for  an  individual 
hellfire  missile  by  a  call  to  the  CSC  missile_hellfire_fly. 

mptr->cos_max_turn[0]  =  cos  (sqrt  (mptr->speed  /  SPEED_0)  THETA_0); 


See  APPENDIX  G  for  a  complete  source  code  listing. 
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3.10.6  SIN_UNGUIDE 

SIN_UNGUIDE  is  a  constant  defining  the  sine  of  the  delta  pitch  angle  for  an 
unguided  hellfire  missile 

3.10.6.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.10.  -  Hellfire  Missile  Characteristics  Data  Array 
for  a  summary  of  the  constants  data. 


#define  SIN_UNGUIDE  hellfr_miss_char[  5] 


3.10.6.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.10.6.2.1  Algorithm 

SIN_UNGUIDE  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the  CSC 
missile_hellfire_fly. 


/V 

If  the  missile  is  not  armed,  fly  in  a  search  trajectory;  otherwise,  fly 
in  a  targeted  trajectory. 

/V 

if(  max_range_limit  >  0  && 

kinematics_range_squared  (veh_kinematics,  mptr->location)  > 
max_range_squared  ) 
missile_target_ground(  mptr  ); 
else  if  (time  <  HELLFIRE_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 
COS_LOCK,  COS_TERM,  COS_LOSE); 

else 

missile_target_agm  (mptr,  target_location,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS_TERM,  COS_LOSE); 


See  APPENDIX  G  for  a  complete  source  code  listing. 
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3.10.7  COS.UNGUIDE 

COS_UNGUIDE  is  a  constant  defining  the  cosine  of  the  delta  pitch  angle  for 
an  unguided  hellfire  missile 

3.10.7.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.10.  -  Hellfire  Missile  Characteristics  Data  Array 
for  a  summary  of  the  constants  data. 


#define  COS_UNGUIDE  hellfr_miss_char[  6] 


3.10.7.2  Usage 

E)uring  real-time  execution,  this  variable  is  not  recomputed. 

3.10.7.2.1  Algorithm 

COS_UNGUIDE  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the 
CSC  missile_hellfire_fly. 


/V 

*  If  the  missile  is  not  armed,  fly  in  a  search  trajectory;  otherwise,  fly 

*  in  a  targeted  trajectory. 

/V 

if(  max_range_limit  >  0  && 

kinematics_range_squared  (veh_kinematics,  mptr->location)  > 
max_range_squared  ) 
missile_target_ground(  mptr  ); 
else  if  (time  <  HELLnRE_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 
COS_LOCK,  COS_TERM,  COS_LOSE); 

else 

missile_target_agm  (mptr,  target_location,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS_TERM,  COS_LOSE); 


See  APPENDIX  G  for  a  complete  source  code  listing. 
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3.10.8  SIN_CLIMB 

SIN_CLIMB  is  a  constant  defining  the  sine  of  the  delta  pitch  angle  for  a 
climbing  hellfire  missile 

3.10.8.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.10.  -  Hellfire  Missile  Characteristics  Data  Array 
for  a  summary  of  the  constants  data. 


#define  SIN_CLIMB  hellfr_miss_char[  7] 


3.10.8.2  Usage 

D.uring  real-time  execution,  this  variable  is  not  recomputed. 

3.10.8.2.1  Algorithm 

SIN_CLIMB  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the  CSC 
missile_hellfire_fly. 


*  If  the  missile  is  not  armed,  fly  in  a  search  trajectory;  otherwise,  fly 

*  in  a  targeted  trajectory. 

/V 

if(  max_range_limit  >  0  && 

kinematics_range_squared  (veh_kinematics,  mptr->location)  > 
max_range_squared  ) 
missile_target_ground(  mptr ); 
else  if  (time  <  HELLFIRE_ARM_TIME) 

nussile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 
COS.LOCK,  COS_TERM,  COS_LOSE); 

else 

missile_target_agm  (mptr,  target_location,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS_TERM,  COS_LOSE); 


See  APPENDIX  G  for  a  complete  source  code  listing. 
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3.10.9  COS_CLIMB 

COS_CLIMB  is  a  constant  defining  the  cosine  of  the  delta  pitch  angle  for  a 
climbing  hellfire  missile 


3.10.9.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.10.  -  Hellfire  Missile  Characteristics  Data  Array 
for  a  summary  of  the  constants  data. 


3.10.9.2  Usage 


Quring  real-time  execution,  this  variable  is  not  recomputed. 


3.10.9.2.1  Algorithm 

COS_CLIMB  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the  CSC 
missile_hellfire_fly. 


*  If  the  missile  is  not  armed,  fly  in  a  search  trajectory;  otherwise,  fly 

*  in  a  targeted  trajectory. 

/V 

if(  max_range_limit  >  0  && 

kinematics_range_squared  (veh_kinematics,  mptr->location)  > 
max_range_squared  ) 
missile_target_ground(  mptr  ); 
else  if  (time  <  HELLnRE_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 
COS_LOCK,  COS_TERM,  COS_LOSE); 

else 

missile_target_agm  (mptr,  target_location,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS_TERM,  COS_LOSE); 


See  APPENDIX  G  for  a  complete  source  code  listing. 
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3.10.10  SIN_LOCK 

SIN_LOCK  is  a  constant  defining  the  sine  of  the  lock  cone  angle  for  a  locked- 
on  hellfire  missile 

3.10.10.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.10.  -  Hellfire  Missile  Characteristics  Data  Array 
for  a  summary  of  the  constants  data. 


#define  SIN_LOCK  hellfr_miss_char[  9] 


3.10.10.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.10.10.2.1  Algorithm 

SIN_LOCK  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the  CSC 
missile_hellfire_fly. 


If  the  missile  is  not  armed,  fly  in  a  search  trajectory;  otherwise,  fly 
in  a  targeted  trajectory. 

/V 

if(  max_range_limit  >  0  && 

kinematics_range_squared  (veh_kinematics,  mptr->location)  > 
max_range_squared  ) 
missile_target_ground(  mptr  ); 
else  if  (time  <  HELLnRE_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CL1MB,  COS_CLIMB,  SIN_LOCK, 
COS_LOCK,  COS_TERM,  COS_LOSE); 

else 

missile_target_agm  (mptr,  target_location,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS.TERM,  COS_LOSE); 


See  APPENDIX  G  for  a  complete  source  code  listing. 
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3.10.11  COS_LOCK 

COS_LOCK  is  a  constant  defining  the  cosine  of  the  lock  cone  angle  for  a 
locked-on  hellfire  missile 

3.10.11.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.10.  -  Hellfire  Missile  Characteristics  Data  Array 
for  a  summary  of  the  constants  data. 


#define  COS  LOCK 

hellfr  miss  char  [10] 

3.10.11.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.10.11.2.1  Algorithm 

COS_LOCK  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the  CSC 
missile_hellfire_fly. 


/V 

If  the  missile  is  not  armed,  fly  in  a  search  trajectory;  otherwise,  fly 
in  a  targeted  trajectory. 

/V 

if(  max_range_limit  >  0  && 

kinematics_range_squared  (veh_kinematics,  mptr->location)  > 
max_range_squared  ) 
missile_target_ground(  mptr  ); 
else  if  (time  <  HELLFIRE_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 
COS_LOCK,  COS_TERM,  COS_LOSE); 

else 

missile_target_agm  (mptr,  target_location,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS_TERM,  COS_LOSE); 


See  APPENDIX  G  for  a  complete  source  code  listing. 
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3.10.12  COS_TERM 

COS_TERM  is  a  constant  defining  the  cosine  of  the  terminal  pitch  angle  for  a 
locked-on  hellfire  missile 


3.10.12.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_hellfire  init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.10.  -  Hellfire  Missile  Characteristics  Data  Array 
for  a  summary  of  the  constants  data. 


#define  COS_TERM 


hellf  r_miss_char  [1 1  ] 


3.10.12.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed. 

3.10.12.2.1  Algorithm 

COS_TERM  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the  CSC 
missile_hellfire_fly. 


/V 

*  If  the  missile  is  not  armed,  fly  in  a  search  trajectory;  otherwise,  fly 

*  in  a  targeted  trajectory. 

/V 

if(  max_range_limit  >  0  &&  ,  •  ^ 

kinematics_range_squared  (veh_kinematics,  mptr->location)  > 

max_range_squared ) 
missile_target_ground(  mptr  ); 
else  if  (time  <  HELLnRE_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGU1DE,  COS_^GUID  , 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 
COS_LOCK,  COS_TERM,  COS_LOSE); 

else 

missile_target_agm  (mptr,  targetjocation,  SIN_UNGUIDE 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 

SIN  LOCK,  COS_LOCK,  COS_TERM,  COS_LOSE); 


See  APPENDIX  G  for  a  complete  source  code  listing. 
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COS_LOSE 

COS_LOSE  is  a  constant  defining  the  cosine  of  the  pitch  angle  for  a  loss-of- 
lock-on  hellfire  missile 

3.10.13.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.10.  -  Hellfire  Missile  Characteristics  Data  Array 
for  a  summary  of  the  constants  data. 


#define  COS_LOSE  hellfr_miss_char[12] 


3.10.13.2  Usage 

Dpring  real-time  execution,  this  variable  is  not  recomputed. 

3.10.13.2.1  Algorithm 

COS_LOSE  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the  CSC 
missile_hellfire_fly. 


/V 

*  If  the  missile  is  not  armed,  fly  in  a  search  trajectory;  otherwise,  fly 

*  in  a  targeted  trajectory. 

/V 

if(  max_range_limit  >  0  && 

kinematics_range_squared  (veh_kinematics,  mptr->location)  > 
max_range_squared  ) 
missile_target_ground(  mptr  ); 
else  if  (time  <  HELLFIRE_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 
COS_LOCK,  COS_TERM,  COS_LOSE); 

else 

missile_target_agm  (mptr,  target_location,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS_TERM,  COS_LOSE); 


See  APPENDIX  G  for  a  complete  source  code  listing. 
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3.11  Hellfr_miss_poly_deg 

The  hellfr_miss_poly_deg  array  consists  of  values  of  the  degree  of  each 
polynomial  equation  used  to  compute  the  time-of-flight,  the  burn  speed,  and 
the  coast  speed  for  the  Hellfire  missile. 

3.11.1  HELLFIRE_TOF_DEG 

HELLFIRE_TOF_DEG  is  a  constant  defining  the  polynomial  degree  for  the 
hellfire  missile  time-of-flight  coefficient  data  array.  HELLFIRE_TOF_DEG  is 
the  first  element  of  the  hellfr_miss_poly_deg  array. 

3.11.1.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.11.  -  Hellfire  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  constants  data. 


#define  HELLFIRE_TOF_DEG  hellfr_miss_poly_deg[  0] 


3.11.1.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed.  The  maximum 
value  for  HELLFIRE_TOF_DEG  is  9,  especially,  the  declared  size  of  the 
hellfire_tof_coeff  array  is  10. 

3.11.1.2.1  Algorithm 

HELLFIRE_TOF_DEG  is  used  to  compute  the  hellfire  missile  time  of  flight 
using  the  CSU  missile_util_eval_poiy,  and  called  by  the  CSU 
missile_hellfire_calc_tof.  The  CSU  missile_util_eval_poly  uses  the 
Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree 
of  polynomial,  coefficient  array,  and  time. 


time  =  missile_util_eval_poly(  HELLFIRE_TOF_DEG, 

hellfire_tof_coeff,  range  ); 
return(  (time  /  speed_factor) ); 


See  APPENDIX  G  for  a  complete  source  code  listing. 
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3.11.2  HELLFIRE_BURN_SPEED_DEG 

HELLnRE_BURN_SPEED_DEG  is  a  constant  defining  the  polynomial  degree 
for  the  hellfire  missile  burn  speed  coefficient  data  array. 
HELLFIRE_BURN_SPEED_DEG  is  the  second  element  of  the 
hellfr_miss_poly_deg  array. 

3.11.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_iniL 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.11.  -  Hellfire  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  constants  data. 


#define  HELLFIRE_BURN_SPEED_DEG  hellfr_miss_poly_deg[  1] 


3!i1.2.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed.  The  maximum 
value  for  HELLnRE_BURN_SPEED_DEG  is  9,  especially,  the  declared  size  of 
the  hellfire_burn_speed_coeff  array  is  10. 

3.11.2.2.1  Algorithm 

HELLFIRE_BURN_SPEED_DEG  is  used  to  compute  the  hellfire  missile  speed 
at  launch  using  the  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missile_hellfire_fire.  The  CSU  missile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


mptr->time  =  0.0; 

vec_copy  (launch_point,  mptr->location); 
mat_copy  (launch_to_world,  mptr->orientation); 
mptr->speed  =  launch_speed  + 

(speed_factor  *  (missile_util_eval_poly 

(HELLFIRE_BURN_SPEED_DEG, 

hellfire_burn_speed_coeff, 

0.0) )); 

mptr->init_speed  =  launch_speed; 
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HELLFIRE_BURN_SPEED_DEG  is  used  to  compute  the  hellfire  missile  speed 
during  powered  flight  [burn]  using  the  CSU  missile_util_eval_poly,  and 
called  by  the  CSU  missile_hellfirejly.  The  CSU  missile_util_eval_poly  uses 
the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 


if  (time  <  HELLnRE_BURNOUT_TIME) 


{ 

mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

(missile_util_eval_poly  (HELLFIRE_BURN_SPEED_DEC, 
hellfire_burn_speed_coeff,  time) )); 


} 

else 


{ 


$ 


} 


mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

(missile_util_eval_poly  (HELLFIRE_COAST_SEEED_DEC, 
hellfire_coast_speed_coeff,  time) )); 


See  APPENDIX  G  for  a  complete  source  code  listing. 

3.11.3  HELLFIRE_COAST_SPEED_DEG 

HELLFIRE_COAST_SPEED_DEG  is  a  constant  defining  the  polynomial 
degree  for  the  hellfire  missile  coast  speed  coefficient  data 
HELLFIRE_COAST_SPEED_DEG  is  the  third  element  of  the 
hellfr_miss_poly_deg  array. 


3.11.3.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_hellfire_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_hellfire_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.11.  -  Hellfire  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  constants  data. 


#define  HELLnRE_COAST_SPEED_DEG  hellfr_miss_poly_deg[  2] 
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3.11.3.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed.  The  maximum 
value  for  HELLFIRE_COAST_SPEED_DEG  is  9,  especially,  the  declared  size  of 
the  hellfire_coast_speed_coeff  array  is  10. 


3.11.3.2.1  Algorithm 


HELLFIRE_COAST_SPEED_DEG  is  used  to  compute  the  hellfire  missile 
speed  during  unpowered  flight  [coast]  using  the  CSU  missile_util_eval_poly, 
and  called  by  the  CSU  missile_hellfire_fly.  The  CSU  missile_util_eval_poly 
uses  the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 


if  (time  <  HELLFIRE_BURNOUT_TIME) 


{ 

mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

(missile_util_eval_poly  (HELLFIRE_BURN_SP EED_DEG, 
hellfire_burn_speed_coeff,  time) )); 


} 

else 


{ 


} 


mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

(missile_util_eval_poly  (HELLnRE_COAST_SPEED_DEG, 
hellfire_coast_speed_coeff,  time) )); 


See  APPENDIX  G  for  a  complete  source  code  listing. 

3.12  Hellfire_tof_coeff 

The  hellfire_tof_coeff  array  consists  of  the  coefficients  for  a  polynomial 
equation  defining  the  Hellfire  missile  time-of-flight  with  respect  to  range  in 
the  form  using  the  Newton-Raphson  method. 

3.12.1  Initialization 

The  hellfire_tof_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_hellfire_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_hellfire_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.12.  -  Hellfire  Missile  Time-Of- 
Flight  Data  Array  for  a  summary  of  the  constants  data. 
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The  array  has  a  maximum  size  of  10  elements. 

3.12.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
HELLFIRE_TOF_DEG  determines  the  number  of  elements  of  the  array  to  be 
used  in  the  polynomial  evaluation. 

3.12.2.1  Algorithm 

The  hellfire_tof_coeff  array  is  used  to  compute  the  hellfire  missile  time  of 
flight  using  the  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missile_hellfire_calc_tof.  The  CSU  missile_util_eval_poly  uses  the 
Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree 
of  polynomial,  coefficient  array,  and  range. 


time  =  missile_util_eval_poly(  HELLFIRE_TOF_DEG, 

hellfire_tof_coeff,  range  ); 
returnf  (time  /  speedjactor) ); 


See  APPENDIX  G  for  a  complete  source  code  listing. 

3.13  Hellfire_burn_speed_coeff 

The  hellfire_burn_speed_coeff  array  consists  of  the  coefficients  for  a 
polynomial  equation  defining  the  Flellfire  missile  burn  speed  with  respect  to 
time  in  the  form  using  the  Newton-Raphson  method. 

3.13.1  Initialization 

The  hellfire_burn_speed_coeff  array  is  initialized  during  execution  of  the 
CSU  missile_hellfire_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_hellfire_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.13.  -  Hellfire  Missile  Burn 
Speed  Data  Array  for  a  summary  of  the  array  data. 

The  array  has  a  maximum  size  of  10  elements. 

3.13.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
HELLnRE_BURN_SPEED_DEG  determines  the  number  of  elements  of  the 
array  to  be  used  in  the  polynomial  evaluation. 
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3.13.2.1  Algorithm 

The  hellfire_burn_speed_coeff  array  is  used  to  compute  the  hellfire  missile 
speed  at  launch  using  the  CSU  missile_utiLeval_poly,  and  called  by  the  CbU 
rnissile  hellfirejire.  The  CSU  missile_utiLevaLpoly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  o 
polynomial,  coefficient  array,  and  time. 


mptr->time  =  0.0; 

vec_copy  (launch_point,  mptr->location); 
mat_copy  (launch_to_world,  mptr->orientation); 
mptr->speed  =  launch_speed  + 

(speedjactor  *  (missile_util_eval_poly 

(HELLFIRE_BURN_SPEED_DEG, 

hellfire_burn_speed_coeff, 

0.0) )); 

mptr->init_speed  =  launch_speed; 


The  hellfire_burn_speed_coeff  array  is  used  to  compute  the  hellfire  missile 
speed  during  powered  flight  [burn]  using  the  CSU  missile_util  eval  poly, 
and  called  by  the  CSU  missile.hellfirejly.  The  CSU  missde_util  eval_poly 
uses  the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 


if  (time  <  HELLnRE_BURNOUT_TIME) 

mptr->speed  =  mptr->init_speed  + 

(speed_f actor  * 

(missile_util_eval_poly  (HELLFIRE_BURN_SPEED_DEG, 
hellfire_burn_speed_coeff,  time) )); 


else 


} 


mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

(missile_util_eval_poly  (HELLFIRE_COAST_SPEED_DEG, 
hellfire_coast_speed_coeff,  time) )); 


See  APPENDIX  G  for  a  complete  source  code  listing. 
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3.14  Hellfire_coast_speed_coeff 

The  hellfire_coast_speed_coeff  array  consists  of  the  coefficients  for  a 
polynomial  equation  defining  the  Hellfire  missile  coast  speed  with  respect  to 
time  in  the  form  using  the  Newton-Raphson  method. 


3.14.1  Initialization 

The  hellfire_coast_speed_coeff  array  is  initialized  during  execution  of  the 
CSU  missile_hellfire_init,  called  by  CSC  weaponsjnit.  Execution  of  the  CSU 
missile_hellfire_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.14.  -  Hellfire  Missile  Coast 
Speed  Data  Array  for  a  summary  of  the  constants  data. 

The  array  has  a  maximum  size  of  10  elements. 


3.14.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
HELLFIRE_COAST_SPEED_DEG  determines  the  number  of  elements  of  the 
array  to  be  used  in  the  polynomial  evaluation. 

3.14.2.1  Algorithm 

The  hellfire_coast_speed_coeff  array  is  used  to  compute  the  hellfire  missile 
speed  during  unpowered  flight  [coast]  using  the  CSU  missile_util_eval_poly, 
and  called  by  the  CSU  missile_hellfire_fly.  The  CSU  missile_util_eval_poly 
uses  the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 


if  (time  <  HELLnRE_BURNOUT_TIME) 

{ 

mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

(missile_util_eval_poly  (HELLFIRE_BURN_SPEED_DEG, 
hellfire_burn_speed_coeff,  time) )); 

} 

else 

{ 

mptr->speed  =  mptr->init_speed  + 

(speed_factor 

(missile_util_eval_poly  (HELLFIRE_COAST_SPEED_DEG, 
hellfire_coast_speed_coeff,  time) )); 

} 
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See  APPENDIX  G  for  a  complete  source  code  listing. 

3.15  Maverick_miss_char 

The  maverick_miss_char  array  consists  of  characteristics  and  parameters 
describing  a  Maverick  missile  system  and  its  performance  constraints. 

3.15.1  MAVERICK_ARM_TIME 

MAVERICK_ARM_TIME  is  a  constant  defining  the  maverick  missile  arm 
time  delay  before  firing  in  ticks. 

3.15.1.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_maverick_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_maverick_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.15.  -  Maverick  Missile 
Characteristics  Data  Array  for  a  summary  of  the  constants  data. 

t 


#define  MAVERICK_ARM_TIME  maverick_miss_char[  0] 


3.15.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.15.1.2.1  Algorithm 

MAVERICK_ARM_TIME  is  used  to  control  computation  of  the  missile 
flyout  path  by  a  call  to  the  CSC  missile_maverick_fly. 


Find  the  target  point  to  which  the  missile  is  to  fly.  The  missile  ignores 
*  any  targets  until  it  is  armed. 

/V 

if  (time  <  MAVERICK_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB, 

COS_CLIMB,  SIN_LOCK, 

COS_LOCK,  COS_TERM,  COS_LOSE); 

else 

{ 

TObjectP  object  =  mvptr  ->  ob)ect_being_tracked; _ 
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V 

«■ 

f 

'V 


Try  to  find  a  target.  If  one  is  found,  fly  towards  it  in  the 
proper  trajectory,  otherwise,  fly  in  a  search  trajectory. 


if  (object  !=  NO_OBJECT) 


{ 


VECTOR  targetjocation; 

GetLocationOfTObject  (object,  targetjocation); 
mvptr->target_vehiclejd  =  object  ->  var.vehiclelD; 
missile  target_agm  (mptr,  targetjocation,  SIN_UNGUm 

“  -  COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 

SIN_LOCK,  COS_LOCK, 

COS_TERM,  COS_LOSE); 


else 


mvptr->  tar  get_vehiclejd.  vehicle  —  vehicleirrelevant, 
if  (TrackAcquire  (mvptr  ->  sensorjd,  vehjist,  mptr  ->  location, 
mptr  ->  orientation[l])  <  0) 
printf  ("missile_maverickjly;  TrackAcquire:  %s\n  , 
TrackErrString  ()); 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  ' 

SIN_CLIMB,  COS_CLIMB,  SIN.LOCK, 
COS_LOCK,  COS_TERM,  COS.LOSE); 


See  APPENDIX  I  for  a  complete  source  code  listing. 


3.15.2  MAVERICK_BURNOUT_TIME 

MAVERICK_BURNOUT_TIME  is  a  constant  defining  the  time  of  powered 
flight  for  maverick  missile  in  ticks. 


3.15.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_inaverick_init,  called  by  CSC  weaponsjmt.  Execubon  of  the  CSU 
missile  maverickjnit  is  normally  done  only  once  during  CSCl  imtializahon 
and  is'performed  sequentially.  See  TABLE  5.1.15.  -  Maverick  Missile 
Characteristics  Data  Array  for  a  summary  of  the  constants  data. 
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3.15.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.15.2.2.1  Algorithm 

MAVERICK_BURNOUT_TIME  is  used  to  control  computation  of  the  missile 
flyout  speed  by  a  call  to  the  CSC  missile_maverick_fly. 


*  Find  the  current  missile  speed  and  the  cosine  of  the  maximum 

allowed  turn  angle.  The  equations  used  are  different  before  and 

*  after  motor  burnout. 

/V 

if  (time  <  MAVERICK_BURNOUT_TIME) 

{ 

mptr->speed  =  missile_util_eval_poly 

(MAVERICK_BURN_SPEED_DEG, 

^  maverick_burn_speed_coeff,  time)  +  mptr->init_speed; 

’} 

else 

{ 

mptr->speed  =  missile_util_eval_poly 

(MAVERICK_COAST_SPEED_DEG, 
maverick_coast_speed_coeff,  time)  +  mptr->init_speed; 

} 


See  APPENDIX  I  for  a  complete  source  code  listing. 

3.15.3  MAVERICK_MAX_FLIGHT_TIME 

MAVERICK_MAX_FLIGHT_TIME  is  a  constant  defining  the  maximum 
flight  time  for  the  maverick  missile  assumed  in  ticks. 

3.15.3.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_maverick_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_maverick_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.15.  -  Maverick  Missile 
Characteristics  Data  Array  for  a  summary  of  the  constants  data. 
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#define  MAVERICK_MAX_FLIGHT_TIME  maverick_miss_char[  2] 


3.15.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.15.3.2.1  Algorithm 

MAVERICK_MAX_FLIGHT_TIME  is  used  to  initialize  the  maximum  flight 
time  for  an  individual  maverick  missile  by  a  call  to  the  CSU 
missile_maverick_init. 


mptr->max_flight_time  =  MAVERICK_MAX_FLIGHT_TIME; 


The  max_flight_time  for  the  each  missile  is  set  to  the  maximum  flight  time 
fQr  an  individual  maverick  missile  by  a  call  to  the  CSU 
missile_maverick_init. 


for  (i  =  0;  i  <  num_missiles;  i++) 

{ 

maverick_array[i].mptr. state  =  MAVERICK_FREE; 
maverick_array[i].mptr.max_flight_time  = 

MAVERICK_MAX_FLIGHT_TIME; 
maverick_array[i].mptr.max_turn_directions  =  1; 
maverick_array[i].object_being_tracked  =  NO_OBJECT; 

maverick_array[i].sensor_id  =  NULL; 

} 


See  APPENDIX  I  for  a  complete  source  code  listing. 

3.15.4  MAVERICK_LOCK_THRESHOLD 

MAVERICK_LOCK_THRESHOLD  is  a  constant  defining  the  cosine  squared 
of  the  lock  threshold  angle  for  the  maverick  missile. 

3.15.4.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_maverick_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_maverick_init  is  normally  done  only  once  during  CSCI  initialization 
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and  is  performed  sequentially.  See  TABLE  5.1.15.  -  Maverick  Missile 
Characteristics  Data  Array  for  a  summary  of  the  constants  data. 


#define  MAVERICK_LOCK_THRESHOLD  maverick_miss_char[  3] 


3.15.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.15.4.2.1  Algorithm 

MAVERICK_LOCK_THRESHOLD  is  used  to  initialize  the  maximum  cone 
threshold  angle  for  the  maverick  missile  by  a  call  to  the  CSU 
missile_maverick_init. 


maverick_cone_threshold  =  MAVERICK_LOCK_THRESHOLD; 

I  _ _  ■ 

The  maverick_cone_of_threshold  and  detectibility  are  computed  by  a  call  to 
the  CSC  missile_maverick_detectibility. 


detectibility  =  sign  (dotProduct)  *  dotProduct  dotProduct  / 
vec_dot_prod  (to_target,  to_target); 

/*  if  the  object  is  outside  the  detection  cone  of  the  sensor, 

*  return  a  detectibility  of  0. 

V 

if  ((mvptr  =  missile_maverick_get_missile_from_sensor_id  (sensor_id)) 

!=  NULL) 

{ 

switch  (mvptr  ->  mptr.state) 

{ 

case  MAVERICK_READY: 

maverick_cone_threshold  =  MAVERICK_LOCK_THRESHOLD, 
break; 

case  MAVERICK_FLYING; 

maverick_cone_threshold  =  MAVERICK_HOLD_THRESHOLD, 
break;  ! 

case  MAVERICK_FREE: 

default:  -n 

printf  ("MaverickPetectibility:  Maverick  not  READY  or  FLYING \n  ); 


-197- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


inaverick_cone_threshold  =  MAVERICK_LOCK_THRESHOLD; 
break; 

} 

if  (detectibility  <  maverick_cone_threshold) 
detectibility  =  0.0; 

} 

else 

{ 

printf  ("MaverickDetectibility;  no  missile  for  sensorlD  %d\n", 
sensor_id); 

} 

return  (detectibility); 


See  APPENDIX  I  for  a  complete  source  code  listing. 

3.15.5  MAVERICK_HOLD_THRESHOLD 

I 

MAVERICK_HOLD_THRESHOLD  is  a  constant  defining  the  cosine  squared 
of  the  hold  threshold  angle  for  the  maverick  missile. 

3.15.5.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_maverick_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_maverick_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.15.  -  Maverick  Missile 
Characteristics  Data  Array  for  a  summary  of  the  constants  data. 


#define  MAVERICK_HOLD_THRESHOLD  maverick_miss_char[  4] 


3.15.5.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.15.5.2.1  Algorithm 

MAVERICK_HOLD_THRESHOLD  is  used  to  compute  the 
maverick_cone_of_threshold  and  detectibility  by  a  call  to  the  CSC 
missile_maverick_detectibility. 
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detectibility  =  sign  (dotProduct)  *  dotProduct  *  dotProduct  / 
vec_dot_prod  (to_target,  to_target); 

/*  if  the  object  is  outside  the  detection  cone  of  the  sensor, 
return  a  detectibility  of  0. 

V 

if  ((mvptr  =  missile_maverick_get_missile_from_sensor_id  (sensor_id)) 

!=  NULL) 

{ 

switch  (mvptr  ->  mptr.state) 

{ 

case  MAVERICK_READY: 

maverick_cone_  threshold  =  MAVERICK_LOCK_THRESHOLD; 
break; 

case  MAVERICK_FLYING: 

maverick_cone_threshold  =  MAVERICK_HOLD_THRESHOLD; 
break; 

<  case  MAVERICK_FREE: 
default: 

printf  ("MaverickDetectibility:  Maverick  not  READY  or  FLYING \n"); 
maverick_cone_threshold  =  MAVERICK_LOCK_THRESHOLD; 
break; 

} 

if  (detectibility  <  maverick_cone_threshold) 
detectibility  =  0.0; 

} 

else 

{ 

printf  ("MaverickDetectibility:  no  missile  for  sensorlD  %d\n", 
sensorjd); 

} 

return  (detectibility); 

See  APPENDIX  I  for  a  complete  source  code  listing. 

3.15.6  SPEED_0 

SPEED_0  is  a  constant  defining  the  reference  turn  speed  used  to  compute  the 
ratio  for  the  maximum  turn  angle. 
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3.15.6.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
mteile  maverick Jnit,  called  by  CSC  weaponsjnit. 

mlssilelmaverickjnlt  is  irormdly  done  only  once  tomg  “Cl  mrdal^^^^^^^ 
and  is  performed  sequentially.  See  TAdL  .  • 

Characteristics  Data  Array  for  a  summary  of  the  constants  data. 


#define  SPEED_0 


maverick_miss_char[  5] 


3.15.6.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 


3.15.6.2.1  Algorithm 

SPEED  0  is  used  lo  compute  the  maximum  turn  angle  for  an  individual 
Lverick  missile  by  a  call  to  the  CSC  missile_maverick_fly. 

1*1 

*  Note  that  this  is  a  temporary  method  of  finding  turn  angle. 

^  mptr->cos_max_turn[0]  =  cos  (sqrt  (mptr->speed  /  (SPEED_0  + 
mptr->init_speed))  *  THETA_0); 

See  APPENDIX  I  for  a  complete  source  code  listing. 


3.15.7  THETA_0 

THETA_0  is  a  constant  defining  the  reference  maximum  turn  angle  which  is 
scaled  for  speed. 


3.15.7.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
mLile_maverick_init,  called  by  CSC  weaponsjnit. 

missile  maverick  init  is  normally  done  only  once  during  CSCI  ini  lalization 
Tn?  irperformed  sequentially'  See  TABLE  5.1.15.  -  Maverick  Missile 
Characteristics  Data  Array  for  a  summary  of  the  constants  data. 
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3.15.7.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.15.7.2.1  Algorithm 

THETA_0  is  used  to  compute  the  maximum  turn  angle  for  an  individual 
maverick  missile  by  a  call  to  the  CSC  missile_maverick_fly. 


See  APPENDIX  I  for  a  complete  source  code  listing. 

3.15.8  SIN_UNGUIDE 

SIN_UNGUIDE  is  a  constant  defining  the  sine  of  the  delta,  pitch  angle  for  an 
unguided  maverick  missile 

3.15.8.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_maverick_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_maverick_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.15.  -  Maverick  Missile 
Characteristics  Data  Array  for  a  summary  of  the  constants  data. 


#define  SIN  UNGUIDE 

maverick_miss_char[  7] 

3.15.8.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.15.8.2.1  Algorithm 

SIN_UNGUIDE  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the  CSC 
missile_maverick_fly. 


*  Find  the  target  point  to  which  the  missile  is  to  fly.  The  missile  ignores 

*  any  targets  until  it  is  armed. 

/V 

if  (time  <  MAVERICK_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 
COSXOCK,  COS_TERM,  COS_LOSE); 


TObjectP  object  =  mvptr  ->  object_being_tracked; 

1*1 

Try  to  find  a  target.  If  one  is  found,  fly  towards  it  in  the 
proper  trajectory,  otherwise,  fly  in  a  search  trajectory. 

/V 

if  (object  !=  NO_OBJECT) 

{ 

VECTOR  targetjocation; 

GetLocationOfTObject  (object,  targetjocation); 
mvptr->target_vehiclejd  =  object  ->  var.vehiclelD; 
missile_target_agm  (mptr,  targetjocation,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS.LOSE); 

} 

else 

{ 

mvptr->target_vehiclejd.  vehicle  =  vehicleirrelevant; 
if  (TrackAcquire  (mvptr  ->  sensor Jd,  vehjist,  mptr  ->  location, 
mptr  ->  orientationfl])  <  0) 
printf  ("missile_maverickjly;  TrackAcquire:  %s\n'’, 
TrackErrString  ()); 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 
SIN_CLIMB,  COS_CLIMB,  SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

} 
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See  APPENDIX  I  for  a  complete  source  code  listing. 

3.15.9  COS_UNGUIDE 

COS_UNGUIDE  is  a  constant  defining  the  cosine  of  the  delta  pitch  angle  for 
an  unguided  maverick  missile 

3.15.9.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_maverickjnit,  called  by  CSC  weaponsjnit.  Execution  of  the  CSU 
missile_maverick_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.15.  -  Maverick  Missile 
Characteristics  Data  Array  for  a  summary  of  the  constants  data. 


#define  COS_UNCUIDE  maverick_miss_char[  8] 


3,15.9.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.15.9.2.1  Algorithm 

COS_UNCUIDE  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the 
CSC  missile_hellfire_fly. 


1*1  .  • 

*  Find  the  target  point  to  which  the  missile  is  to  fly.  The  imssile  ignores 

*  any  targets  until  it  is  armed. 

/V 

if  (time  <  MAVERICK_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNCUIDE,  COS_UNCUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 
COS_LOCK,  COS_TERM,  COS_LOSE); 

else 

{ 

TObjectP  object  =  mvptr  ->  object_being_tracked; 

/*/ 

*  Try  to  find  a  target.  If  one  is  found,  fly  towards  it  in  the 

*  proper  trajectory,  otherwise,  fly  in  a  search  trajectory. 

/V 

if  (object  !=  NO_OBJECT) 

{ 

VECTOR  targetjocation; _ _ _ _ 
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GetLocationOfTObject  (object,  target_location); 
mvptr->target_vehicle_id  =  object  ->  var.vehiclelD; 
missile_target_agm  (mptr,  target_location,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

else 

{ 

mvptr->target_vehicle_id.  vehicle  =  vehicleirrelevant; 
if  (TrackAcquire  (mvptr  ->  sensor_id,  veh_list,  mptr  ->  location, 
mptr  ->  orientationfl])  <  0) 
printf  ("missile_maverick_fly:  TrackAcquire:  %s\n", 
TrackErrString  ()); 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS.UNGUIDE, 
SIN_CLIMB,  COS_CLIMB,  SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

} 

t 

See  APPENDIX  I  for  a  complete  source  code  listing. 

3.15.10  SIN_CLIMB 

SIN_CLIMB  is  a  constant  defining  the  sine  of  the  delta  pitch  angle  for  a 
climbing  maverick  missile 

3.15.10.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_maverick_init,  called  by^CSC  weapons_init.  Execution  of  the  CSU 
missile_maverick_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.15.  -  Maverick  Missile 
Characteristics  Data  Array  for  a  summary  of  the  constants  data. 


#define  SIN_CLIMB  maverick_miss_char[  9] 


3.15.10.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.15.10.2.1  Algorithm 

SIN_CLIMB  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the  CSC 
missile_maverick_fly. 


*  Find  the  target  point  to  which  the  missile  is  to  fly.  The  missile  ignores 

*  any  targets  until  it  is  armed. 

/V 

if  (time  <  MAVERICK_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 

COS_LOCK,  COS.TERM,  COS_LOSE); 

else 

TObjectP  object  =  mvptr  ->  object_being_tracked; 

1*1  .  •  •  V 

Try  to  find  a  target.  If  one  is  found,  fly  towards  it  m  the 

*  proper  trajectory,  otherwise,  fly  in  a  search  trajectory. 

/*/ 

if  (object  !=  NO_OBJECT) 

{ 

VECTOR  targetjocation; 

GetLocationOfTObject  (object,  targetjocation); 
mvptr->target_vehiclejd  =  object  ->  var.vehiclelD; 
missile_target_agm  (mptr,  targetjocation,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

else 

mvptr->target_vehiclejd.  vehicle  =  vehicleirrelevant; 
if  (TrackAcquire  (mvptr  ->  sensor_id,  vehjist,  mptr  ->  location, 
mptr  ->  orientation[l])  <  0) 
printf  ("missile_maverickjly:  TrackAcquire;  %s\n", 
TrackErrString  ()); 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 
SIN_CLIMB,  COS_CLIMB,  SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

} 
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See  APPENDIX  I  for  a  complete  source  code  listing. 

3.15.11  COS_CLIMB 

COS_CLIMB  is  a  constant  defining  the  cosine  of  the  delta  pitch  angle  for  a 
climbing  maverick  missile 

3.15.11.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_maverick_init,  called  by  CSC  weapons_iriit.  Execution  of  the  CSU 
missile  maverick  init  is  normally  done  only  once  during  CSCI  initialization 
and  is~performe’d  sequentially.  See  TABLE  5.1.15.  -  Maverick  Missile 
Characteristics  Data  Array  for  a  summary  of  the  constants  data. 


#define  COS_CLIMB  maverick_miss_char[10] 


3.15.11.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.15.11.2.1  Algorithm 

COS_CLIMB  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the  CSC 
missile_maverick_fly. 


Find  the  target  point  to  which  the  missile  is  to  fly.  The  missile  ignores 
any  targets  until  it  is  armed. 

/V 

if  (time  <  MAVERICK_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 
COS_LOCK,  COS_TERM,  COS.LOSE); 

else 

TObjectP  object  =  mvptr  ->  object_being_tracked; 

Try  to  find  a  target.  If  one  is  found,  fly  towards  it  m  the 
proper  trajectory,  otherwise,  fly  in  a  search  trajectory. 

/V 

if  (object  !=  NO_OBJECT) 

{ 

VECTOR  targetjocation; _ _ _ _ 
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GetLocationOfTObject  (object,  targetjocation); 
mvptr->target_vehicle_id  =  object  ->  var.vehiclelD; 
missile_target_agm  (mptr,  targetjocation,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

else 

mvptr->target_vehiclejd.  vehicle  =  vehicleirrelevant; 
if  (TrackAcquire  (mvptr  ->  sensorjd,  vehjist,  mptr  ->  location, 
mptr  ->  orientationfl])  <  0) 
printf  (''missile_maverickjly;  TrackAcquire:  %s\n", 
TrackErrString  ()); 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 
SIN_CLIMB,  COS_CLIMB,  SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

} 

t 


See  APPENDIX  I  for  a  complete  source  code  listing. 

3.15.12  SIN.LOCK 

SIN_LOCK  is  a  constant  defining  the  sine  of  the  lock  cone  angle  for  a  locked- 
on  maverick  missile 

3.15.12.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_maverickjnit,  called  by  CSC  weaponsjnit.  Execution  of  the  CSU 
missile_maverickjnit  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.15.  -  Maverick  Missile 
Characteristics  Data  Array  for  a  summary  of  the  constants  data. 


#define  SIN_LOCK  maverick_nuss_char[ll] 


3.15.12.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.15.12.2.1  Algorithm 

SIN_LOCK  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the  CSC 
missile_maverick_fly. 


1*1 

Find  the  target  point  to  which  the  missile  is  to  fly.  The  missile  ignores 

*  any  targets  until  it  is  armed. 

/V 

if  (time  <  MAVERICK_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 
COS_LOCK,  COS_TERM,  COS_LOSE); 

else 

{ 

TObjectP  object  =  mvptr  ->  object_being_tracked; 

/V 

* ,  Try  to  find  a  target.  If  one  is  found,  fly  towards  it  in  the 

*  proper  trajectory,  otherwise,  fly  in  a  search  trajectory. 

/V 

if  (object  !=  NO_OBJECT) 

{ 

VECTOR  targetjocation; 

GetLocationOfTObject  (object,  targetjocation); 
mvptr->target_vehiciejd  =  object  ->  var.vehiclelD; 
missile_target_agm  (mptr,  targetjocation,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

else 

{ 

mvptr->target_vehiclejd.vehicle  =  vehicleirrelevant; 
if  (TrackAcquire  (mvptr  ->  sensorjd,  vehjist,  mptr  ->  location, 
mptr  ->  orientation[l])  <  0) 
printf  ("missile_maverick_fly:  TrackAcquire:  %s\n", 
TrackErrString  ()); 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 
SIN_CLIMB,  COS_CLIMB,  SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

} 
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See  APPENDIX  I  for  a  complete  source  code  listing. 

3.15.13  COS.LOCK 

COS_LOCK  is  a  constant  defining  the  cosine  of  the  lock  cone  angle  for  a 
locked-on  maverick  missile 

3.15.13.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_maverick_init,  called  by  CSC  weaponsjnit.  Execution  of  the  CSU 
missile_maverick_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.15.  -  Maverick  Missile 
Characteristics  Data  Array  for  a  summary  of  the  constants  data. 


#define  COS_LOCK  maverick_miss_char[12] 


3.15.13.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.15.13.2.1  Algorithm 

COS_LOCK  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the  CSC 
missile_maverick_fly. 

/V 

*  Find  the  target  point  to  which  the  missile  is  to  fly.  The  missile  ignores 

*  any  targets  until  it  is  armed. 

/V 

if  (time  <  MAVERICK_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 

COS_LOCK,  COS_TERM,  COS_LOSE); 

else 

{ 

TObjectP  object  =  mvptr  ->  object_being_tracked; 

/V 

*  Try  to  find  a  target.  If  one  is  found,  fly  towards  it  in  the 

*  proper  trajectory,  otherwise,  fly  in  a  search  trajectory. 

/V 

if  (object  !=  NO_OBJECT) 

{ 

_ VECTOR  target_location; _ _ 
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GetLocationOfTObject  (object,  target_location); 
mvptr->target_vehicle_id  =  object  ->  var.vehiclelD; 
missile_target_agm  (mptr,  target_location,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

else 

{ 

mvptr->target_vehicle_id.  vehicle  =  vehicleirrelevant; 
if  (TrackAcquire  (mvptr  ->  sensor_id,  veh_list,  mptr  ->  location, 
mptr  ->  orientation[l])  <  0) 
printf  ("missile_maverick_fly:  TrackAcquire:  %s\n", 
TrackErrString  ()); 

missile_target_agm  (mptr,  NULL,  SESJ_UNGUIDE,  COS_UNGUIDE, 
SIN_CLIMB,  COS_CLIMB,  SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

) 


See  APPENDIX  I  for  a  complete  source  code  listing. 

3.15.14  COS.TERM 

COS_TERM  is  a  constant  defining  the  cosine  of  the  terminal  pitch  angle  for  a 
locked-on  maverick  missile 

3.15.14.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_maverick_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_maverick_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.15.  -  Maverick  Missile 
Characteristics  Data  Array  for  a  summary  of  the  constants  data. 


#define  COS_TERM  maverick_miss_char[13] 


3.15.14.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.15.14.2.1  Algorithm 

COS_TERM  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the  CSC 
missile_maverick_fly. 


/V 

*  Find  the  target  point  to  which  the  missile  is  to  fly.  The  missile  ignores 

*  any  targets  until  it  is  armed. 

/V 

if  (time  <  MAVERICK_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 
COS.LOCK,  COS_TERM,  COS_LOSE); 

else 

{ 

TObjectP  object  =  mvptr  ->  object_being_tracked; 

/V 

Try  to  find  a  target.  If  one  is  found,  fly  towards  it  in  the 

*  proper  trajectory,  otherwise,  fly  in  a  search  trajectory. 

/V 

if  (object  !=  NO_OBJECT) 

{ 

VECTOR  targetjocation; 

GetLocationOfTObject  (object,  targetjocation); 
mvptr->target_vehiclejd  =  object  ->  var.vehiclelD; 
missilejarget_agm  (mptr,  targetjocation,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

else 

{ 

mvptr->target_vehiclejd.vehicle  =  vehicleirrelevant; 
if  (TrackAcquire  (mvptr  ->  sensorjd,  vehjist,  mptr  ->  location, 
mptr  ->  orientation[l])  <  0) 
printf  ("missile_maverickjly;  TrackAcquire:  %s\n", 
TrackErrString  ()); 

missilejarget_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 
SIN_CLIMB,  COS_CLIMB,  SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

} 
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See  APPENDIX  I  for  a  complete  source  code  listing. 

3.15.15  COS_LOSE 

COS_LOSE  is  a  constant  defining  the  cosine  of  the  pitch  angle  for  a  loss-of- 
lock-on  maverick  missile 

3.15.15.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_maverick_init,  called  by  CSC  weaponsjnit.  Execution  of  the  CSU 
missile_maverick_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.15.  -  Maverick  Missile 
Characteristics  Data  Array  for  a  summary  of  the  constants  data. 


#define  COS  LOSE 

maverick  miss_char[14] 

3.15.15.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.15.15.2.1  Algorithm 

COS_LOSE  is  used  to  compute  the  missile  flyout  path  by  a  call  to  the  CSC 
missile_maverick_fly. 


/V 

*  Find  the  target  point  to  which  the  missile  is  to  fly.  The  missile  ignores 

*  any  targets  until  it  is  armed. 

/V 

if  (time  <  MAVERICK_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK, 
COS_LOCK,  COS_TERM,  COS_LOSE); 

else 

{ 

TObjectP  object  =  mvptr  ->  object_being_tracked; 

/V 

Try  to  find  a  target.  If  one  is  found,  fly  towards  it  in  the 

*  proper  trajectory,  otherwise,  fly  in  a  search  trajectory. 

/V 

if  (object  !=  NO_OBJECT) 

{ 

_ VECTOR  targetjocation; _ _ _ 
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GetLocationOfTObject  (object,  target_location); 
mvptr->target_vehicle_id  =  object  ->  var.vehiclelD; 
missile_target_agm  (mptr,  target_location,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB, 
SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

else 

{ 

mvptr->target_vehicle_id.  vehicle  =  vehicleirrelevant; 
if  (TrackAcquire  (mvptr  ->  sensorjd,  vehjist,  mptr  ->  location, 
mptr  ->  orientation[l])  <  0) 
printf  ("missile_maverick_fly:  TrackAcquire:  %s\n", 
TrackErrString  ()); 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 
SIN_CLIMB,  COS_CLIMB,  SIN_LOCK,  COS_LOCK,  COS_TERM, 
COS_LOSE); 

} 

} 


See  APPENDIX  I  for  a  complete  source  code  listing. 

3.16  Maverick_miss_poly_deg 

The  maverick_miss_poly_deg  array  consists  of  values  of  the  degree  of  each 
polynomial  equation  used  to  compute  the  burn  speed  and  the  coast  speed  for 
the  Maverick  missile. 

3.16.1  MAVERICK_BURN_SPEED_DEG 

MAVERICK_BURN_SPEED_DEG  is  a  constant  defining  the  polynomial 
degree  for  the  Maverick  missile  burn  speed  coefficient  data  array. 
MAVERICK_BURN_SPEED_DEG  is  the  first  element  of  the 
maverick_miss_poly_deg  array. 

3.16.1.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_maverick_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_maverick_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.16.  -  Maverick  Missile 
Polynomial  Degree  Data  Array  for  a  summary  of  the  constants  data. 
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#define  MAVERICK_BURN_SPEED_DEG  naaverick_miss_poly_deg[  0] 


3.16.1.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed.  The  maximum 
value  for  MAVERICK_BURN_SPEED_DEG  is  4,  especially,  the  declared  size 
of  the  maverick_burn_speed_coeff  array  is  5. 

3.16.1.2.1  Algorithm 

MAVERICK_BURN_SPEED_DEG  is  used  to  compute  the  maverick  missile 
speed  at  launch  using  the  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missile_maverick_fire.  The  CSU  missile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


,  mptr->time  =  0.0; 

vec_copy  (launch_point,  mptr->location); 
mat_copy  (launch_to_world,  mptr->orientation); 

mptr->speed  =  missile_util_eval_poly  (MAVERICK_BURN_SPEED_DEG, 
maverick_burn_speed_coeff,  0.0)  +  launch_speed; 
mptr->init_speed  =  launch_speed; 


MAVERICK_BURN_SPEED_DEG  is  used  to  compute  the  maverick  missile 
speed  during  powered  flight  [burnl  using  the  CSU  missile_util_eval_poly, 
and  called  by  the  CSU  missile_maverick_fly.  The  CSU 
missile_util_eval_poly  uses  the  Newton-Raphson  method  to  evaluate  the 
polynomial  with  inputs  of  degree  of  polynomial,  coefficient  array,  and  time. 


mptr  =  &(mvptr->mptr); 
time  =  mptr->time; 

/V 

*  Find  the  current  missile  speed  and  the  cosine  of  the  maximum 

*  allowed  turn  angle.  The  equations  used  are  different  before 
and  after  motor  burnout. 

/V 

if  (time  <  MAVERICK_BURNOUT_TIME) 

{ 

mptr->speed  =  missile_util_evai_poly  ( 

MAVERICK_BURN_SPEED_DEG, 
maverick_burn_speed_coeff,  time)  +  mptr->init_speed; 
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} 

else 

{ 

mptr->speed  =  inissile_util_eval_poly  ( 

MAVERICK_COAST_SPEED_DEG, 
maverick_coast_speed_coeff,  time)  +  mptr->init_speed; 

} 


See  APPENDIX  I  for  a  complete  source  code  listing. 

3.16.2  MAVERICK_COAST_SPEED_DEG 

MAVERICK_COAST_SPEED_DEG  is  a  constant  defining  the  polynomial 
degree  for  the  maverick  missile  coast  speed  coefficient  data  array. 
MAVERICK_COAST_SPEED_DEG  is  the  second  element  of  the 
maverick_miss_poly_deg  array. 

3.16.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU 
missile_maverick_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_maverick_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.16.  -  Maverick  Missile 
Polynomial  Degree  Data  Array  for  a  summary  of  the  constants  data. 


#define  MAVERICK_COAST_SPEED_DEG  maverick_miss_poly_deg[  1] 


3.16.2.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed.  The  maximum 
value  for  MAVERICK_COAST_SPEED_DEG  is  4,  especially,  the  declared  size 
of  the  maverick_coast_speed_coeff  array  is  5. 

3.16.2.2.1  Algorithm 

MAVERICK_COAST_SPEED_DEG  is  used  to  compute  the  maverick  missile 
speed  during  unpowered  flight  [coast]  using  the  CSU  missile_util_eval_poly, 
and  called  by  the  CSU  missile_maverick_fly.  The  CSU 
missile_util_eval_poly  uses  the  Newton-Raphson  method  to  evaluate  the 
polynomial  with  inputs  of  degree  of  polynomial,  coefficient  array,  and  time. 
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mptr  =  &(mvptr->mptr); 
time  =  mptr->time; 

/V 

*  Find  the  current  missile  speed  and  the  cosine  of  the  maximum 

*  allowed  turn  angle.  The  equations  used  are  different  before 

*  and  after  motor  burnout. 

/V 

if  (time  <  MAVERICK_BURNOUT_TIME) 

{ 

mptr->speed  =  missile_util_eval_poly  ( 

MAVERICK_BURN_SPEED_DEG, 
maverick_burn_speed_coeff,  time)  +  mptr->init_speed; 

} 

else 

{ 

mptr->speed  =  missile_util_eval_poly  ( 

MAVERICK_COAST_SPEED_DEG, 
maverick_coast_speed_coeff,  time)  +  mptr->init_speed; 

’} 


See  APPENDIX  I  for  a  complete  source  code  listing. 

3.17  Maverick_burn_speed_coe£f 

The  maverick_burn_speed_coeff  array  consists  of  the  coefficients  for  a 
polynomial  equation  defining  the  Maverick  missile  burn  speed  with  respect 
to  time  in  the  form  using  the  Newton-Raphson  method. 

3.17.1  Initialization 

The  maverick_burn_speed_coeff  array  is  initialized  during  execution  of  the 
CSU  missile_maverick_init,  called  by  CSC  weapons_init.  Execution  of  the 
CSU  missile_maverick_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.17.  -  Maverick 
Missile  Burn  Speed  Data  Array  for  a  summary  of  the  array  data. 

The  array  has  a  maximum  size  of  5  elements. 

3.17.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
MAVERICK_BURN_SPEED_DEG  determines  the  number  of  elements  of  the 
array  to  be  used  in  the  polynomial  evaluation. 
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3.17.2.1  Algorithm 

The  maverick_burn_speed_coeff  array  is  used  to  compute  the  maverick 
missile  speed  at  launch  using  the  CSU  missile_util_eval_poly,  and  called  by 
the  CSU  missile_maverick_fire.  The  CSU  missile_util_eval_poly  uses  the 
Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree 
of  polynomial,  coefficient  array,  and  time. 


mptr->time  =  0.0; 

vec_copy  (launch_point,  mptr->location); 
mat_copy  (laimch_to_world,  mptr->orientation); 

mptr->speed  =  missile_util_eval_poly  (MAVERICK_BURN_SPEED_DEG, 
maverick_burn_speed_coeff,  0.0)  +  launch_speed; 
mptr->init_speed  =  launch_speed; 


The  maverick_burn_speed_coeff  array  is  used  to  compute  the  maverick 
m«issile  speed  during  powered  flight  [burn]  using  the  CSU 
missile_util_eval_poly,  and  called  by  the  CSU  missile_maverick_fly.  The 
CSU  missile_util_eval_poly  uses  the  Newton-Raphson  method  to  evaluate 
the  polynomial  with  inputs  of  degree  of  polynomial,  coefficient  array,  and 
time. 


mptr  =  &(mvptr->mptr); 
time  =  mptr->time; 

/V 

*  Find  the  current  missile  speed  and  the  cosine  of  the  maximum 

allowed  turn  angle.  The  equations  used  are  different  before 

*  and  after  motor  burnout. 

/V 

if  (time  <  MAVERICK_BURNOUT_TIME) 

{ 

mptr->speed  =  missile_util_eval_poly  ( 

MAVERICK_BURN_SPEED_DEG, 
maverick_burn_speed_coeff,  time)  +  mptr->init_speed; 

} 

else 

{ 

mptr->speed  =  missile_util_eval_poly  ( 

MAVERICK_COAST_SPEED_DEG, 
maverick_coast_speed_coeff,  time)  +  mptr->init_speed; 

} 
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See  APPENDIX  I  for  a  complete  source  code  listing. 

3.18  Maverick_coast_speed_coeff 

The  maverick_coast_speed_coeff  array  consists  of  the  coefficients  for  a 
polynomial  equation  defining  the  Maverick  missile  coast  speed  with  respect 
to  time  in  the  form  using  the  Newton-Raphson  method. 

3.18.1  Initialization 

The  maverick_coast_speed_coeff  array  is  initialized  during  execution  of  the 
CSU  missile_maverick_init,  called  by  CSC  weapons_init.  Execution  of  the 
CSU  missile_maverick_init  is  normally  done  only  once  during  CSCI 
initialization  and  is  performed  sequentially.  See  TABLE  5.1.18.  -  Maverick 
Missile  Coast  Speed  Data  Array  for  a  summary  of  the  constants  data. 

The  array  has  a  maximum  size  of  5  elements. 

3.18.2  Usage 

t 

During  real-time  execution,  this  array  is  not  recomputed. 
MAVERICK_COAST_SPEED_DEG  determines  the  number  of  elements  of 
the  array  to  be  used  in  the  polynomial  evaluation. 

3.18.2.1  Algorithm 

The  maverick_coast_speed_coeff  array  is  used  to  compute  the  maverick 
missile  speed  during  unpowered  flight  [coast]  using  the  CSU 
missile_util_eval_poly,  and  called  by  the  CSU  missile_maverick_fly.  The 
CSU  missile_util_eval_poly  uses  the  Newton-Raphson  method  to  evaluate 
the  polynomial  with  inputs  of  degree  of  polynomial,  coefficient  array,  and 
time. 


mptr  =  &(mvptr->mptr); 
time  =  mptr->time; 

/V 

*  Find  the  current  missile  speed  and  the  cosine  of  the  maximum 

*  allowed  turn  angle.  The  equations  used  are  different  before 

*  and  after  motor  burnout. 

/V 

if  (time  <  MAVERICK_BURNOUT_TIME) 

{ 

mptr->speed  =  missile_util_evai_poly  ( 

MAVERICK_BURN_SPEED_DEG, 

_ _ maverick_burri_speed_coeff,  time)  +  mptr->init_speed; 


-218- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


} 

else 

{ 

mptr->speed  =  missile_util_eval_poly  ( 

MAVERICK_COAST_SPEED_DEG, 
maverick_coast_speed_coeff,  time)  +  mptr->init_speed; 

} 


See  APPENDIX  I  for  a  complete  source  code  listing. 

3.19  Stinger_miss_char 

The  stinger_miss_char  array  consists  of  characteristics  and  parameters 
describing  a  Stinger  missile  system  and  its  performance  constraints. 

3.19.1  STINGER_BURNOUT_TIME 

STINGER_BURNOUT_TIME  is  a  constant  defining  the  time  of  powered 
flight  for  stinger  missile  in  ticks. 

3.19.1.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_stinger_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_stinger_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentiaUy.  See  TABLE  5.1.19.  -  Stinger  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  STINGER_BURNOUT_TIME  stinger_miss_char[  0] 


3.19.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.19.1.2.1  Algorithm 

STINGER_BURNOUT_TIME  is  used  to  control  computation  of  the  missile 
flyout  speed  and  the  cosine  of  the  maximum  allowed  turn  by  a  call  to  the  CSC 
missile_stinger_fly. 
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Find  the  current  missile  speed  and  the  cosine  of  the  maximum 
allowed  turn  angle.  The  equations  used  are  different  before  and 
after  motor  burnout. 

/ 

if  (time  <  STINGER_BURNOUT_TIME) 

( 

mptr->speed  =  missile_util_eval_poly  (STINGER_BURN_SPEED_DEG, 
stinger_burn_speed_coeff,  time)  +  mptr->init_speed; 


mptr->speed  =  missile_util_eval_poly  (STINGER_COAST_SPEED_DEG, 
stinger_coast_speed_coeff,  time)  +  mptr->init_speed; 


Note  that  this  is  a  temporary  method  of  finding  turn  angle. 

7 

'  mptr->cos_max_turn[0]  =  cos  (sqrt  (mptr->speed  /  (SPEED_0  + 
mptr->init_speed))  *  THETA_0); 

7 

Try  to  find  a  target.  If  one  is  found,  fly  towards  it  in  the 
proper  trajectory,  otherwise,  fly  in  a  straight  line. 

7 

target  =  near_get_preferred_veh_near_vector  (&(sptr->target_vehicle_id), 
veh_list,  mptr->location,  mptr->orientation[l], 
STINGER_LOCK_THRESHOLD); 
if(  max_range_limit  >  0  && 

kinematics_range_squared  (veh_kinematics,  mptr->location)  > 
max_range_squared  ) 
missile_target_ground(  mptr  ); 
else  if  (target  !=  NULL) 

{ 

sptr->target_vehicle_id  =  target->vehicleID; 
if  (time  <  STINGER_BURNOUT_TIME) 

missile_target_intercept_pre_burndut  (mptr,  target, 

sptr->stinger_burn_range_coeff,  STINGER_BURNOUT_TIME, 
S'nNGER_BURN_SPEED_DEG  +  1, 
sptr->stinger_coast_range_coeff, 
sptr->stinger_coast_range_2_coeff, 
STINGER_COAST_SPEED_DEG  +  1); 
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else 

missile_target_intercept  (mptr,  target, 
sptr->stinger_coast_range_coeff, 
sp  tr->  s  tinger_coas  t_r  ange_2_coeff , 
STINGER_COAST_SPEED_DEG  +  1); 

} 

else 

{ 

sptr->target_vehicle_id.  vehicle  =  vehicleirrelevant; 
missile_target_unguided  (mptr); 


See  APPENDIX  K  for  a  complete  source  code  listing. 

3.19.2  STINGER_MAX_FLIGHT_TIME 

STINGER_MAX_FLIGHT_TIME  is  a  constant  defining  the  maximum  flight 
time  for  the  stinger  missile  assumed  in  ticks. 

t 

3.19.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_stinger_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_stinger_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.19.  -  Stinger  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  STINGER_MAX_FLIGHT_TIME  stinger_miss_char[  1] 


3.19.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.19.2.2.1  Algorithm 

STINGER_MAX_FLIGHT_TIME  is  used  to  initialize  the  maximum  flight 
time  for  an  individual  stinger  missile  by  a  call  to  the  CSU 
missile_stinger_init. 
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for  (i  =  0;  i  <  num_missiles;  i++) 

{ 

stinger_array[i].mptr.state  =  STINGER_FREE; 
s  tinger_arr  ay  [i]  .mp  tr  .inax_flight_time  = 

STINGER_MAX_FLIGHT_TIME; 
stinger_array[i].mptr.max_turn_directions  =  1; 

} 


See  APPENDIX  K  for  a  complete  source  code  listing. 

3.19.3  STINGER_LOCK_THRESHOLD 

STINGER_LOCK_THRESHOLD  is  a  constant  defining  the  cosine  squared  of 
the  lock  threshold  angle  for  the  stinger  missile. 

3.19.3.1  Initialization 

T^e  constant  is  initialized  during  execution  of  the  CSU  missile_stinger_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_stinger_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.19.  -  Stinger  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 

#define  STINGER_LOCK_THRESHOLD  stinger_miss_char[  2] 


3.19.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.19.3.2.1  Algorithm 

STINGER_LOCK_THRESHOLD  is  used  to  compute  a  target  during  pre¬ 
launch  by  a  call  to  the  CSU  missile_stinger_pre_launch. 


/V 

Try  to  find  a  target. 

/V 

target  =  near_get_preferred_veh_near_vector  (&(sptr->target_vehicle_id), 
vehjist,  launch_point,  launch_to_world[l], 
STINGER_LOCK_THRESHOLD); 
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STINGER_LOCK_THRESHOLD  is  used  to  compute  the  target  by  a  call  to  the 
CSC  missile_stinger_fly. 


*  Try  to  find  a  target.  If  one  is  found,  fly  towards  it  in  the 
proper  trajectory,  otherwise,  fly  in  a  straight  line. 

/V 

target  =  near_get_preferred_veh_near_vector  (&(sptr->target_vehicle_id), 
vehjist,  mptr->location,  mptr->orientation[l], 
STINCER_LOCK_THRESHOLD); 


See  APPENDIX  K  for  a  complete  source  code  listing. 

3.19.4  SPEED_0 

SPEED_0  is  a  constant  defining  the  reference  turn  speed  used  to  compute  the 
ratio  for  the  maximum  turn  angle. 

i 

3.19.4.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_stinger_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_stinger_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.19.  -  Stinger  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  SPEED_0  stinger_miss_char[  3] 


3.19.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.19.4.2.1  Algorithm 

SPEED_0  is  used  to  compute  the  maximum  turn  angle  for  an  individual 
stinger  missile  by  a  call  to  the  CSC  missile_stinger_fly. 
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See  APPENDIX  K  for  a  complete  source  code  listing. 


3.19.5  THETA_0 

default  is  15.0  deg/sec  ,  u-  v.  • 

THETA  0  is  a  constant  defining  the  reference  maximum  turn  angle  which  is 

scaled  for  speed. 

3.19.5.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_stinger_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_stmger_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.19.  -  Sdnger  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


3.19.5.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 


3.19.5.2.1  Algorithm 


THETA_0  is  used  to  compute  the  maximum  turn  angle  for  an  individual 
stinger  missile  by  a  call  to  the  CSC  missile_stinger_fly. 


See  APPENDIX  K  for  a  complete  source  code  listing. 
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3.19.6  INVEST_DIST_SQ 

The  INVEST_DIST_SQ  is  a  constant  defining  the  area  at  a  maximum  speed 
of  less  than  100  m/ sec. 


3.19.6.1  Initialization 

The  INVEST  DIST  SQ  is  initialized  during  execution  of  the  CSU 
missile_stingerjnit,  called  by  CSU  weaponsjnit.  See  TABLE  5.1.19.  -  Stinger 
Missile  Characteristics  Data  Array  for  a  summary  of  the  constant. 


#define  INVEST_DIST_SQ  stinger_miss_char[5] 


3.19.6.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3^19.6.2.1  Algorithm 

INVEST  DIST_SQ  is  used  to  compute  detonation  of  the  proximity  fuze  by  a 
call  in  the  CSU  missile_stinger_fly. 


If  the  missile  successfully  flew,  process  the  proximity  fuze. 

1*1 

if  (sptr->target_vehicle_id.vehicle  ==  vehicleirrelevant) 
missile_fuze_prox  (mptr,  MSL_TYPE_MISSILE, 
PROX_FUZE_ON_ALL_VEH, 
&(sptr->target_vehicle_id),  &(sptr->pptr), 
vehjist,  INVEST_DIST_SQ,  FUZE_DIST_SQ); 

else  ^  ^ 

missile_fuze_prox  (mptr,  MSL_TYPE_MISSILE, 
PROX_FUZE_ON_ONE_VEH, 
&(sptr->target_vehicle_id),  &(sptr->pptr), 
vehjist,  INVEST_DIST_SQ,  FUZE_DIST_SQ); 


See  APPENDIX  K  for  a  complete  source  code  listing. 


3.19.7  FUZE_DIST_SQ 

FUZE_DIST_SQ  is  a  constant  defining  the  square  of  the  radius  of  the  cylinder 
describing  the  flechettes  fly  in  a  cylinder  with  a  radius  of  20  meters  and  a 
length  of  750  meters 
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3.19.7.1  Initialization 

The  FUZE_DIST_SQ  is  initialized  during  execution  of  the  CSU 
missile_stinger_init,  called  by  CSU  weaponsjnit.  See  TABLE  5.1.19.  -  Stinger 
Missile  Characteristics  Data  Array  for  a  summary  of  the  constant. 


#define  FUZE_DIST_SQ  stinger_miss_char[  6] 


3.19.7.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.19.7.2.1  Algorithm 

FUZE_DIST_SQ  is  used  to  compute  detonation  of  the  proximity  fuze  by  a  call 
in  the  CSU  missile_stinger_fly. 


/V  .  .  , 

If  the  missile  successfully  flew,  process  the  proximity  fuze. 

/V  ... 

if  (sptr->target_vehicle_id. vehicle  ==  vehicleirrelevant) 
missile_fuze_prox  (mptr,  MSL_TYPE_MISSILE, 
PROX_FUZE_ON_ALL_VEH, 
&(sptr->target_vehiclejd),  &(sptr->pptr), 
vehjist,  INVEST_DIST_SQ,  FUZE_DIST_SQ); 

else 

missile_fuze_prox  (mptr,  MSL_TYPE_MISSILE, 
PROX_FUZE_ON_ONE_VEH, 
&(sptr->target_vehicle_id),  &(sptr->pptr), 
vehjist,  INVEST_DIST_SQ,  FUZE_DIST_SQ); 


See  APPENDIX  K  for  a  complete  source  code  listing. 

3.20  Stinger_miss_poly_deg 

The  stinger_miss_poly_deg  array  consists  of  values  of  the  degree  of  each 
polynomial  equation  used  to  compute  the  burn  speed  and  the  coast  speed  for 
the  Stinger  missile. 

3.20.1  STINGER_BURN_SPEED_DEG 

STINGER_BURN_SPEED_DEG  is  a  constant  defining  the  polynomial  degree 
for  the  Stinger  missile  burn  speed  coefficient  data  array. 
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STINGER  BURN_SPEED_DEG  is  the  first  GlGinGirt  of  thG 
stingGr_miss_poly_dGg  array.  STINGER_BURN_SPEED_DEG  is  also  knowir 
as  stingGr_miss_poly_dGg[  0]. 

3.20.1.1  Initialization 

ThG  constant  is  initialized  during  execution  of  the  CSU  missile_stinger_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_stingerjnit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.20.  -  Stinger  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  constants  data. 

3.20.1.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed.  The  value  for 
stinger_miss_poly_deg[  0]  is  1,  especially,  the  declared  size  of  the 
stinger_burn_speed_coeff  array  is  2.  This  value  cannot  be  changed  with  a 
change  to  the  source  code  because  of  other  dependencies  in  the  code  structure. 

3,20.1.2.1  Algorithm 

STINGER_BURN_SPEED_DEG  is  used  to  compute  the  stinger  missile  speed 
at  launch  using  the  CSU  missile_utiLeval_poly,  and  called  by  the  CSU 
missile.stingerjire.  The  CSU  missile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


*  Get  a  pointer  to  the  generic  elements  of  the  STINGER  missile.  This 

*  improves  code  readability. 

/V 

mptr  =  &(sptr->mptr); 

/V 

Set  the  initial  time,  location,  orientation  and  speed  of  the  generic 

*  missile. 

/V 

mptr->time  =  0.0; 

vec_copy  (launch_point,  mptr->location); 
mat_copy  (launch_to_world,  mptr->orientation); 
mptr->speed  =  launch_speed  + 

(speed_factor  * 

mis sile_u til_e v al_poly  (STIN GER_BURN_SPEE  D_DEG , 
stinger_burn_speed_coeff,  0.0)); 
mptr->init_speed  =  launch_speed; 
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STINGER  BURN_SPEED_DEG  is  used  to  compute  the  stinger  missile  speed 
during  powered  flight  [burn]  using  the  CSU  missile_util  eval  poly,  an 
called  by  the  CSU  missile_stinger_fly.  The  CSU  missile_utiLeval_poly  uses 
the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 


/V 

*  Set  mptr_  and  _tinaG_-  These  values  are  created  mostly  for  increased 
readablity. 

/V 

mptr  =  &(sptr->mptr); 
time  =  mptr->time; 

/*/ 

*  Find  the  current  missile  speed  and  the  cosine  of  the  maximum  allowed 

*  turn  angle.  The  equations  used  are  different  before  and  after 

*  motor  burnout. 

/*/ 

if  (time  <  STINGER_BURNOUT_TIME) 

mptr->speed  =  missile_util_eval_poly  (STINGER_BURN_SPEED_DEG, 
stinger_burn_speed_coeff,  time)  +  mptr->init_speed;  j 

} 

else 

mptr->speed  =  missile_utiLeval_poly  (STINGER_COAST_SPEED_DEG, 
stinger_coast_speed_coeff,  time)  +  mptr->init_speed; 

} 


See  APPENDIX  K  for  a  complete  source  code  listing. 


3.20.2  STINGER_COAST_SPEED_DEG 

STINGER_COAST_SPEED_DEG  is  a  constant  defining  the  polynomial  degree 
for  the  stinger  missile  coast  speed  coefficient  data 
STINGER  COAST_SPEED_DEG  is  the  second  element  of  the 
stinger_miss_poly_deg  array.  STINGER_COAST_SPEED_DEG  is  a  so 
known  as  stinger_miss_poly_deg[  1]. 


3.20.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_stinger_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_stinger  init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
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sequentially.  See  TABLE  5.1.20.  -  Stinger  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  constants  data. 

3.20.2.2  Usage 

During  real-time  execution,  this  variable  is  not  recomputed.  The  value  for 
STINGER_COAST_SPEED_DEG  is  3,  especially,  the  declared  size  of  the 
stinger  coast_speed_coeff  array  is  4.  This  value  cannot  be  changed  with  a 
change  to  the  source  code  because  of  other  dependencies  in  the  code  structure. 

3.20.2.2.1  Algorithm 

STINGER_COAST_SPEED_DEG  is  used  to  compute  the  stinger  missile  speed 
during  unpowered  flight  [coast]  using  the  CSU  missile_util_eval_poly,  and 
called  by  the  CSU  missile_stinger_fly.  The  CSU  missile_util_eval_poly  uses 
the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 


1*1 

*  Set  mptr  and  _time_.  These  values  are  created  mostly  for  increased 

*  readablity. 

/V 

mptr  =  &(sptr->mptr); 
time  =  mptr->time; 

/*/ 

*  Find  the  current  missile  speed  and  the  cosine  of  the  maximum  allowed 

*  turn  angle.  The  equations  used  are  different  before  and  after 

*  motor  burnout. 

/V 

if  (time  <  STINGER_BURNOUT_TIME) 

mptr->speed  =  missile_util_eval_poly  (STINGER_BURN_SPEED_DEG, 
stinger_burn_speed_coeff,  time)  +  mptr->init_speed; 

} 

else 

mptr->speed  =  missile_util_eval_poly  (STINGER_COAST_SPEED_DEG, 
stinger_coast_speed_coeff,  time)  +  mptr->init_speed; 

} 


See  APPENDIX  K  for  a  complete  source  code  listing. 
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3.21  Stinger_burn_speed_coeff 

The  stinger_burn_speed_coeff  array  consists  of  the  coefficients  for  a 
polynomial  equation  defining  the  Stinger  missile  burn  speed  with  respect  to 
time  in  the  form  using  the  Newton-Raphson  method. 

3.21.1  Initialization 

The  stinger_burn_speed_coeff  array  is  initialized  during  execution  of  the 
CSU  missile_stinger_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile  stinger_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  “performed  sequentially.  See  TABLE  5.1.21.  -  Stinger  Missile  Burn 
Speed  Data  Array  for  a  summary  of  the  array  data. 

The  array  has  a  maximum  size  of  5  elements. 

3.21.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
STINGER_BURN_SPEED_DEG  determines  the  number  of  elements  of  the 
array  to  be  used  in  the  polynomial  evaluation. 

3.21.2.1  Algorithm 

The  stinger_burn_speed_coeff  array  is  used  to  compute  the  stinger  missile 
speed  at  launch  using  the  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missile_stinger_fire.  The  CSU  missile_util_evaLpoly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


Get  a  pointer  to  the  generic  elements  of  the  STINGER  missile.  This 

*  improves  code  readability. 

/V 

mptr  =  &(sptr->mptr); 

/V 

Set  the  initial  time,  location,  orientation  and  speed  of  the  generic 

*  missile. 

/V 

mptr->time  =  0.0; 

vec_copy  (launch_point,  mptr->location); 

mat_copy  (launch_to_world,  mptr->orientation);  _ 
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mptr->speed  =  launch_speed  + 

(speed_factor  * 

missile_util_eval_poly  (STINGER_BURN_SPEED_DEG, 
stinger_burn_speed_coeff,  0.0)); 
mptr->init_speed  =  launch_speed; 


The  stin2er_burn_speed_coeff  array  is  used  to, compute  the  stinger  missile 
speed  during  powered  flight  [burn]  using  the  CSU  missile_util  eval  poly, 
and  called  by  the  CSU  missile_stinger_fly.  The  CSU  missUe_util_eval_poly 
uses  the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 


/V 

Set  _mptr_  and  _time_.  These  values  are  created  mostly  for  increased 

*  readablity. 

/V 

mptr  =  &:(sptr->mptr); 
time  =  mptr->time; 

1*1 

*  Find  the  current  missile  speed  and  the  cosine  of  the  maximum  allowed 

*  turn  angle.  The  equations  used  are  different  before  and  after 

*  motor  burnout. 

1*1 

if  (time  <  STINGER_BURNOUT_TIME) 

mptr->speed  =  missile_util_eval_poly  (STINGER_BURN_SPEED_DEG, 
stinger_burn_speed_coeff,  time)  +  mptr->init_speed;  j 

} 

else 

mptr->speed  =  missile_util_eval_poly  (STINGER_COAST_SPEED_DEG, 
stinger_coast_speed_coeff,  time)  +  mptr->init_speed; 

} 


See  APPENDIX  K  for  a  complete  source  code  listing. 


3.22  Stinger_coast_speed_coef£ 

The  stinger_coast_speed_coeff  array  consists  of  the  coefficients  for  a 
polynomial  equation  defining  the  Stinger  missile  coast  speed  with  respect  to 
time  in  the  form  using  the  Newton-Raphson  method. 
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3.22.1  Initialization 

The  stinger_coast_speed_coeff  array  is  initialized  during  execution  of  the 
CSU  missile_stinger_init,  called  by  CSC  weaponsjnit.  Execution  of  the  CSU 
missile_stinger_init  is  normally  done  only  once  during  CSCI  initialization 
and  is  performed  sequentially.  See  TABLE  5.1.22.  -  Stinger  Missile  Coast 
Speed  Data  Array  for  a  summary  of  the  constants  data. 

The  array  has  a  maximum  size  of  5  elements. 

3.22.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
STINGER_COAST_SPEED_DEG  determines  the  number  of  elements  of  the 
array  to  be  used  in  the  polynomial  evaluation. 

3.22.2.1  Algorithm 

The  stinger_coast_speed_coeff  array  is  used  to  compute  the  stinger  missile 
speed  during  unpowered  flight  [coast]  using  the  CSU  missile_util_eval_poly, 
and  called  by  the  CSU  missile_stinger_fly.  The  CSU  missile_util_eval_poly 
uses  the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 


/V 

*  Set  _mptr_  and  _time_.  These  values  are  created  mostly  for  increased 

*  readablity. 

/V 

mptr  =  &(sptr->mptr); 
time  =  mptr->time; 

/V  .  .  ^ 

*  Find  the  current  missile  speed  and  the  cosine  of  the  maximum  allowed 

*  turn  angle.  The  equations  used  are  different  before  and  after 

*  motor  burnout. 

/V 

if  (time  <  STINGER_BURNOUT_TlME) 

mptr->speed  =  missile_util_eval_poly  (STINGER_BURN_SPEED_DEG, 
stinger_burn_speed_coeff,  time)  +  mptr->init_speed; 

}  _ _ _ _ _ - _ 
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else 

{ 

mptr->speed  =  missile_util_eval_poly  {STINGER_COAST_SPEED_DEG, 
stinger_coast_speed_coeff,  time)  +  mptr->init_speed; 

} 


See  APPENDIX  K  for  a  complete  source  code  listing. 

3.23  Tow_miss_char 

The  tow_miss_char  array  consists  of  characteristics  and  parameters  describing 
a  TOW  missile  system  and  its  performance  constraints. 

3.23.1  TOW_BURNOUT_TIME 

TOW_BURNOUT_TIME  is  a  constant  defining  the  time  of  powered  flight  for 
tow  missile  in  ticks. 

3.23.1.1  Initialization 

I 

The  constant  is  initialized  during  execution  of  the  CSU  missile_tow_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_tow_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.23.  -  Tow  Missile  Characteristics  Data  Array  for  a 
summary  of  the  constants  data. 


#define  TOW_BURNOUT_TIME  tow_miss_char[  0] 


3.23.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.23.1.2.1  Algorithm 

TOW_BURNOUT_TIME  is  used  to  control  computation  of  the  missile  flyout 
speed  and  the  cosines  of  the  maximum  allowed  turn  angles  in  each  direction 
by  a  call  to  the  CSC  missile_tow_fly. 


/V 

Find  the  current  missile  speed  and  the  cosines  of  the  maximum 

*  allowed  turn  angles  in  each  direction.  The  equations  used  are 

*  different  before  and  after  motor  burnout. 

/V  _ 
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if  (time  <  TOW_BURNOUT_TIME) 

mptr->speed  =  mptr->init_speed  + 

(speedjactor  * 

missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time), 

} 

else 

{ 

mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time); 

} 


See  APPENDIX  L  for  a  complete  source  code  listing. 

$ 

3,23.2  TOW_RANGE_LIMIT_TIME 

TOW_RANGE_LIMIT_TIME  is  a  constant  defining  the  range  limit  time  for 
the  tow  missile  in  ticks;  at  this  point  the  wire  is  cut,  but  the  missile  is  allowed 
to  fly  to  the  maximum  flight  time. 

3.23,2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_tow_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_tow_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.23.  -  Tow  Missile  Characteristics  Data  Array  for  a 
summary  of  the  constants  data. 


#define  TOW_RANGE_LIMIT_TIME  tow_miss_char[  1] 
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3.23.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.23.2.2.1  Algorithm 

T0W_RANGE_LIMIT_TIME  is  used  to  control  the  wire  cut  for  an 
individual  tow  missile  by  a  call  to  the  CSU  missile_towJly 


/V 

If  the  missile  has  reached  its  maximum  range  (not  the  maximum  distance 
its  allowed  to  fly),  cut  the  wire. 

/V 

#ifdef  notdeff  .  .  ,v 

if  ((time  >  TOW_RANGE_LIMIT_TIME)  &&  !tptr->wire_is_cut) 

tptr->wirejs_cut  =  TRUE; 

#endif 

,  if  (!tptr->wire_is_cut  && 

((time  >  TOW_RANGE_LIMIT_TIME)  I  I 

(max_range_limit  >  0  &&  ,  •  n 

kinematics_range_squared  (veh_kinematics,  mptr->location)  > 

max_range_squared) )) 
tptr->wire_is_cut  =  TRUE; 


See  APPENDIX  L  for  a  complete  source  code  listing. 


3.23.3  TOW_MAX_FLIGHT_TIME 

TOW  MAX_FLIGHT_TIME  is  a  constant  defining  the  maximum  flight  time 
for  the  tow  missile  assumed  in  ticks;  cosine  of  the  max  turn  is  greater  than 
1.0  beyond  this  point. 


3.23.3.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_tow_mit, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_tow  init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performe 
sequentially.  See  TABLE  5.1.23.  -  Tow  Missile  Characteristics  Data  Array  for  a 
summary  of  the  constants  data. 
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3.23.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.23.3.2.1  Algorithm 

TOW_MAX_FLIGHT_TIME  is  used  to  initialize  the  maximum  flight  time 
for  an  individual  tow  missile  by  a  call  to  the  CSU  missile_tow_init. 


tptr->mptr.max_flight_time  =  T0W_MAX_FLIGHT_TIME; 


See  APPENDIX  L  for  a  complete  source  code  listing. 

3.24  Tow_miss_poly_deg 

The  tow_miss_poly_deg  array  consists  of  values  of  the  degree  of  each 
polynomial  equation  used  to  compute  the  burn  speed,  the  coast  speed, 
rhaximum  cosines  of  turns  while  powered,  and  maximum  cosines  of  turns 
while  unpowered  for  the  TOW  missile. 

3.24.1  TOW_BURN_SPEED_DEG 

TOW_BURN_SPEED_DEG  is  a  constant  defining  the  polynomial  degree  for 
the  tow  missile  burn  speed  coefficient  data  array. 

3.24.1.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_tow_init, 
called  by  the  CSC  weapons_init.  Execution  of  the  CSU  missile_tow_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.24.  -  Tow  Missile  Polynomial  Degree  Data  Array 
for  a  summary  of  the  constants  data. 


#define  TOW_BURN_SPEED_DEG  tow_miss_poly_deg[0] 


3.24.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  TOW_BURN_SPEED_DEG  is  4,  especially,  the  declared  size  of  the 
tow_burn_speed_coeff  is  5. 
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3.24.1.2.1  Algorithm 


TOW  BURN_SPEED_DEG  is  used  to  compute  the  tow  missile  speed  a 
launch  using  the  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missile, towjire.  The  CSU  missile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


1*1 

Set  the  initial  time,  location,  orientation,  and  speed  of  the  generic 
missile. 

/V 

mptr->time  =  0.0; 

vec_copy  (launch_point,  mptr-> location); 
mat  copy  (loc_sight_to_world,  mptr->orientation), 

tow_bum_speed_coeff,  0.0)); 
mptr->init_speed  =  launch_speed; 


TOW  BURN  SPEED.DEG  is  used  to  compute  the  tow  missile  speed  during 
poweTed  flight  [burn]  using  the  CSU  missile.util.evaLpoly,  and  called  by 
the  CSU  inissile.towjly.  The  CSU  missile_utiLeval_poly  uses  the 
Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree 
of  polynomial,  coefficient  array,  and  time. 


/V 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum 

allowed  turn  angles  in  each  direction.  The  equations  used  are 

*  different  before  and  after  motor  burnout. 

1*1 

if  (time  <  TOW_BURNOUT_TIME) 

mptr->speed  =  mptr->init_speed  + 

(speed_factor 

missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time), 

} 

else 

{  _ _ _ _ _ _ _ 
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mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time); 

} 


See  APPENDIX  L  for  a  complete  source  code  listing. 

3.24.2  TOW_COAST_SPEED_DEG 

TOW_COAST_SPEED_DEG  is  a  constant  defining  the  polynomial  degree  for 
tow  missile  coast  speed  coefficient  data  array 

3.24.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_tow_init, 
called  by  the  CSC  weaponsjnit.  Execution  of  the  CSU  missile_tow_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.24.  -  Tow  Missile  Polynomial  Degree  Data  Array 
for  a  summary  of  the  array  data. 


#define  TOW_COAST_SPEED_DEG  tow_miss_poly_deg[l] 


3.24.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  TOW_COAST_SPEED_DEG  is  4,  especially,  the  declared  size  of  the 
tow_burn_speed_coeff  is  5. 

3.24.2.2.1  Algorithm 

TOW_COAST_SPEED_DEG  is  used  to  compute  the  tow  missile  speed  during 
unpowered  flight  [coast]  using  the  CSU  missile_util_eval_poly,  and  called  by 
the  CSU  missile_tow_fly.  The  CSU  missile_util_eval_poly  uses  the 
Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree 
of  polynomial,  coefficient  array,  and  time. 


Find  the  current  missile  speed  and  the  cosines  of  the  maximum 
*  allowed  turn  angles  in  each  direction.  The  equations  used  are 
different  before  and  after  motor  burnout. 

/V  _ _ _ 
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if  (time  <  TOW_BURNOUT_TIME) 

{ 

mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time); 

} 

else 

{ 

mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time); 

} 


See  APPENDIX  L  for  a  complete  source  code  listing. 

I 

3.24.3  TOW_BURN_TURN_DEG 

TOW_BURN_TURN_DEG  is  a  constant  defining  the  polynomial  degree  for 
each  tow  missile  burn  turn  coefficient  data  sub-array  of  the  tow  missile  burn 
turn  coefficient  data  array  structure 

3.24.3.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_tow_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_tow_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.24.  -  Tow  Missile  Polynomial  Degree  Data  Array 
for  a  summary  of  the  constant  data. 


#define  TOW_BURN_TURN_DEG  tow_miss_poly_deg[2] 


3.24.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  TOW_BURN_TURN_DEG  is  1,  especially,  the  declared  size  of  the 
tow_burn_turn_coeff  is  2.  Changing  this  constant  requires  a  recompile 
because  of  the  hard  coded  multi-dimension  characteristic. 
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/V 

Coefficients  for  the  cosine  of  max  turn  polynomials  before  motor  burnout. 

*  The  structure  _MAX_COS_COEFF_  is  used  to  store  the  values  for  the  turn 

*  sideways,  up,  and  down  polynomials  along  with  their  order. 

/V 

static  MAX_COS_COEFF  tow_burn_turn_coeff  = 

{ 

1,  I*  Order  of  the  polynomials.  * ! 

{ 

I*  Sidewards  turn. 

0.999976868652,  /*  a_0  -  cos(rad)/tick 
-3.5933955e-7  / a_l  -  cos(rad) / tick*=^2 

}, 

{ 

/"^Upwards  turn.  * ! 

0.999960667258,  /*  a_0  -  cos(rad)/tick 
-3.1492328e-6  I*  a_l  -  cos(rad)/tick=^=^2  *! 

{ 

I*  Downwards  turn.  * ! 

0.999978909989,  I*  a_0  -  cos(rad)/tick 
-7.8194991e-9  /*  a_l  -  cos(rad)/tick*’^  V 

} 


3.24.3.2.1  Algorithm 

TOW_BURN_TURN_DEG  is  hard  coded  by  type  definition  of 
MAX_COS_COFFF  and  is  used  to  compute  the  cosine  of  the  maximum 
allowed  turn  angle  in  each  axis  for  the  tow  missile  during  powered  flight 
[burn]  using  the  CSU  missile_util_cos_coeff,  and  called  by  the  CSU 
missile_tow_fly.  The  CSU  missile_util_cos_coeff  uses  the  Newton-Raphson 
method  to  evaluate  the  polynomial  with  inputs  of  missile  pointer,  coefficient 
array,  and  time. 


/V 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum 

’*■  allowed  turn  angles  in  each  direction.  The  equations  used  are 

*  different  before  and  after  motor  burnout. 

/V 
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if  (time  <  TOW_BURNOUT_TIME) 

{ 

mptr->speed  =  mptr->init_speed  + 

(speed_factor 

missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time); 

} 

else 

{ 

mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time); 

} 


See  APPENDIX  L  for  a  complete  source  code  listing. 

3.24.4  TOW_COAST_TURN_DEG 

TOW_COAST_TURN_DEG  is  a  constant  defining  the  polynomial  degree  for 
each  tow  missile  coast  turn  coefficient  data  sub-array  of  the  tow  missile  coast 
turn  coefficient  data  array  structure 

3.24.4.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_tow_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_tow_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.24.  -  Tow  Missile  Polynomial  Degree  Data  Array 
for  a  summary  of  the  array  data. 


#define  TOW_COAST_TURN_DEG  tow_miss_poly_deg[3] 


3.24.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  of  each  axis  for  TOW_COAST_TURN_DEG  is  3,  especially,  the 
declared  size  of  the  tow_coast_turn_coeff  is  4.  Changing  this  constant 
requires  a  recompile  because  of  the  hard  coded  multi-dimension 
characteristic. 
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Coefficients  for  the  cosine  of  max  turn  polynomials  after  motor  burnout. 

/V 

static  MAX_COS_COEFF  tow_coast_turn_coeff  = 

3^  I*  Order  of  the  polynomials.  *! 

( 

I*  Sidewards  turn. 

0.99995112518,  I*  a_0  -  cos(rad)/tick  *! 

8.96333e-7,  /*  a_l  -  cos(rad)/tick="’'2  *! 

-5.995375e-9,  I*  cos(rad)/tick**3  *! 

1.162225e-ll  I*  a_3  -  cos(rad)/ tick’^M  *! 

}, 

{ 

/*  Upwards  turn.  * ! 

0.9998498495,  /*  a_0  -  cos(rad)/tick  *! 

1.657779e-6,  I*  a_l  -  cos(rad)/tick’^*2  *! 

'  -8.231861e-9,  7=^  a_2  -  cos(rad)/tick’'*3  V 

1.381832e-ll  I*  a_3  -  cos(rad)/tick’'M  *! 

{ 

I*  Downwards  turn.  * ! 

0.9999714014,  /*  a_0  -  cos(rad)/tick  V 
3.382077e-7,  a_l  -  cos(rad)/tick**2  */ 

-1.601259e-9,  /”"  a_2  -  cos(rad)/tick**3 

2.623014e-12  /*  a_3  -  cos(rad)/tick’"M  *! 

} 

}; 


3.24.4.2.1  Algorithm 

TOW_COAST_TURN_DEG  is  hard  coded  by  type  definition  of 
MAX_COS_COEFF  and  is  used  to  compute  the  cosine  of  the  maximum 
allowed  turn  angle  in  each  axis  for  the  tow  missile  during  unpowered  flight 
[coast]  using  the  CSU  missile_util_cos_coeff,  and  called  by  the  CSU 
missile_tow_fly.  The  CSU  missile_util_cos_coeff  uses  the  Newton-Raphson 
method  to  evaluate  the  polynomial  with  inputs  of  missile  pointer,  coefficient 
array,  and  time. 
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/V 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum 

allowed  turn  angles  in  each  direction.  The  equations  used  are 

*  different  before  and  after  motor  burnout. 

/V 

if  (time  <  TOW_BURNOUT_TIME) 

mptr->speed  =  mptr->init_speed  + 

(speedjactor  * 

missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)); 

missile  util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time), 

} 

else 

mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 

'  tow_coast_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time); 


See  APPENDIX  L  for  a  complete  source  code  listing. 


3.25  Tow_burn_speed_coeff 

The  tow_burn_speed_coeff  array  consists  of  the  coefficients  for  a  polynomial 
equation  defining  the  TOW  missile  burn  speed  with  respect  to  time  in  the 
form  using  the  Newton-Raphson  method. 


3.25.1  Initialization 

The  tow_burn_speed_coeff  array  is  initialized  during  execution  of  the  CSU 
missile.towjnit,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile  tow  init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.25.  -  TOW  Missile  Burn  Speed 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 


The  array  has  a  maximum  size  of  5  elements. 


3.25.2  Usage 

During  real-time  execution,  this  array  is  not  recoinputed. 
TOW_BURN_SPEED_DEG  determines  the  number  of  elements  of  the  array 
to  be  used  in  the  polynomial  evaluation. 
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3.25.2.1  Algorithm 

Tow_burn_speed_coeff  is  used  to  compute  the  tow  missile  speed  at  launch 
using  the  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missile_tow_fire.  The  CSU  missile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


"*■  Set  the  initial  time,  location,  orientation,  and  speed  of  the  generic 
missile. 

/V 

mptr->time  =  0.0; 

vec_copy  (launch_point,  mptr->location); 
mat_copy  (loc_sight_to_world,  mptr->orientation); 
mptr->speed  =  launch_speed  + 

(speedjactor  missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 

tow_burn_speed_coeff,  0.0)); 

'  mptr->init_speed  =  launch_speed; 


Tow_burn_speed_coeff  is  used  to  compute  the  tow  missile  speed  during 
powered  flight  [burn]  using  the  CSU  missile_util_eval_poly,  and  called  by 
the  CSU  missile_tow_fly.  The  CSU  missile_util_eval_poly  uses  the 
Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree 
of  polynomial,  coefficient  array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum 

allowed  turn  angles  in  each  direction.  The  equations  used  are 

*  different  before  and  after  motor  burnout. 

/V 

if  (time  <  TOW_BURNOUT_TIME) 

{ 

mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time); 

} 

else 

{ 

mptr->speed  =  mptr->init_speed  + 

_ (speed_factor  * _ _ _ _ _ 
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missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time), 

} 


See  APPENDIX  L  for  a  complete  source  code  listing. 

3.26  Tow_coast_speed_coeff 

This  data  array  consists  of  the  coefficients  for  a  polynomial  equation  defining 
the  TOW  missile  coast  speed  with  respect  to  time  in  the  form  using  the 
Newton-Raphson  method. 


3.26.1  Initialization 

The  tow_coast_speed_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_tow_init,  called  by  CSC  weaponsjnit.  Execution  of  the  CSU 
missile  tow  init  is  normally  done  only  once  during  CSCI  initialization  and 
ii  performed  sequentially.  See  TABLE  5.1.26.  -  TOW  Missile  Coast  Speed 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 


The  array  has  a  maximum  size  of  5  elements. 


3.26.2  Usage 

During  real-time  execution,  this  array  is  not  recornputed. 
TOW_COAST_SPEED_DEC  determines  the  number  of  elements  of  the  array 
to  be  used  in  the  polynomial  evaluation. 

3.26.2.1  Algorithm 

Tow  coast_turn_coeff  is  used  to  compute  the  tow  missile  speed 
unpowered  flight  [coast]  using  the  CSU  missile_util_evaLpoly,  and  called  by 
the  CSU  missile_tow_fly.  The  CSU  missile_util_eval_poly  uses  the 
Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree 
of  polynomial,  coefficient  array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum 

allowed  turn  angles  in  each  direction.  The  equations  used  are 

*  different  before  and  after  motor  burnout. 

/V 

if  (time  <  TOW_BURNOUT_TIME) 

{ _ _ _ 
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mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time); 

} 

else 

{ 

mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time); 


See  APPENDIX  L  for  a  complete  source  code  listing. 

3.27  Tow_burn_turn_coeff 

I 

The  tow_burn_turn_coeff  two-dimensional  data  array  consists  of  the 
coefficients  for  three  polynomial  equations  [sidewards,  upwards,  and 
downwards  movement]  defining  the  TOW  missile  maximum  cosine  of  turn 
while  powered  with  respect  to  time  in  the  form  using  the  Newton-Raphson 
method. 

3.27.1  Initialization 

The  tow_burn_turn_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_tow_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_tow_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.27.  -  TOW  Missile  Burn  Turn 
Coefficients  Data  Array  for  a  suiiunary  of  the  array  data. 

The  array  has  a  maximum  size  of  3  by  2  elements. 


/V 

*  Coefficients  for  the  cosine  of  max  turn  polynomials  before  motor  burnout. 

*  The  structure  _MAX_COS_COEFF_  is  used  to  store  the  values  for  the  turn 

*  sideways,  up,  and  down  polynomials  along  with  their  order. 

/V 

static  MAX_COS_COEFF  tow_burn_turn_coeff  = 

{ 

1, _ /*  Order  of  the  polynomials.  */ _ 
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I*  Sidewards  turn.  */ 
0.999976868652,  I*  a_0  -  cos(rad)/tick  *! 
-3.5933955e-7  I*  a_l  *  cos(rad)/tick’^*2  *! 

}, 

{ 

/“^Upwards  turn.  */ 

0.999960667258,  I*  a_0  -  cos(rad)/ tick  *! 
-3.1492328e-6  I*  a_l  -  cos(rad)/tick*’^2  *! 

}, 

{ 

I*  Downwards  turn. 
0.999978909989,  a_0  -  cos(rad)/tick  *! 

-7.8194991e-9  I*  a_l  -  cos(rad)/tick’^*2  *! 

} 


Changing  this  constant  requires  a  recompile  because  of  the  hard  coded  multi¬ 
dimension  characteristic. 

3.27.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed.  The  size  of  the 
array  in  the  type  definition  for  MAX_COS_COEFF  determines  the  number  of 
elements  of  the  array  to  be  used  in  the  polynomial  evaluation. 

3.27.2.1  Algorithm 

Tow_burn_turn_coeff  is  used  to  compute  the  cosine  of  the  maximum 
allowed  turn  angle  in  each  axis  for  the  tow  missile  during  powered  flight 
[burn]  using  the  CSU  missile_util_cos_coeff,  and  called  by  the  CSU 
missile_tow_fly.  The  CSU  missile_util_cos_coeff  uses  the  Newton-Raphson 
method  to  evaluate  the  polynomial  with  inputs  of  missile  pointer,  coefficient 
array,  and  time. 


/V 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum 

*  allowed  turn  angles  in  each  direction.  The  equations  used  are 

*  different  before  and  after  motor  burnout. 

/V 

if  (time  <  TOW_BURNOUT_TIME) 

{ 

mptr->speed  =  mptr->init_speed  + 

_ (speed_factor  * _ _ 
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missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time); 

} 

else 

{ 

mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

mis  sile_u  til_e val_poly  (TO W_CO AST_SPEE  D_DEG , 
tow_coast_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &:tow_coast_turn_coeff,  time); 


See  APPENDIX  L  for  a  complete  source  code  listing. 

3.28  Tow_coast_turn_coeff 

The  tow_coast_turn_coeff  two-dimensional  data  array  consists  of  the 
coefficients  for  three  polynomial  equations  [sidewards,  upwards,  and 
downwards  movement]  defining  the  TOW  missile  maximum  cosine  of  turn 
while  unpowered  with  respect  to  time  in  the  form  using  the  Newton- 
Raphson  method. 

3.28.1  Initialization 

The  tow_coast_turn_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_tow_init,  called  by  CSC  weapons_mit.  Execution  of  the  CSU 
missile_tow_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.28.  -  TOW  Missile  Coast  Turn 
Coefficients  Data  Array  for  a  summary  of  the  array  data. 

The  array  has  a  maximum  size  of  3  by  4  elements. 


/V 

*  Coefficients  for  the  cosine  of  max  turn  polynomials  after  motor  burnout. 

/V 

static  MAX_COS_COEFF  tow_coast_turn_coeff  = 

{ 

3,  /*  Order  of  the  polynomials.  */ 

{ 

/*  Sidewards  turn.  */ 

0.99995112518,  /*  a_0  -  cos(rad)/tick  */ 

8.96333e-7,  /*  a_l  -  cos(rad)/tick**2  */ _ 
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-5.995375e-9,  /="  a_2  -  cos(rad)/tick=^’'3  *! 

1.162225e-ll  /’'  a_3  -  cos(rad)/tick=^M  *! 


/*  Upwards  turn.  *! 
0.9998498495,  a_0  -  cos(rad)/ tick  *! 

1.657779e-6,  I*  a_l  -  cos(rad)/ tick’'*2  *! 
-8.231861e-9,  I*  a_2  -  cos(rad)/tick’^='3  *! 
1.381832e-ll  I*  a_3  -  cos(rad)/ tick’^M  *! 

}, 

I*  Downwards  turn.  * ! 
0.9999714014,  /*  a_0  -  cos(rad)/  tick  *! 

3.382077e-7,  /’"  a_l  -  cos(rad)/ tick="’'2  *! 

-1.601259e-9,  I*  a_2  -  cos(rad)/ tick*’'3  *! 
2.623014e-12  1*^3-  cos(rad)/  tick="M  */ 

} 

}; 


Changing  the  size  of  the  array  requires  a  recompile  because  of  the  hard  coded 
multi-dimension  characteristic. 


3.28.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed.  The  size  of  the 
array  in  the  type  definition  for  MAX_COS_COEFF  determines  the  number  of 
elements  of  the  array  to  be  used  in  the  polynomial  evaluation. 


3.28.2.1  Algorithm 


Tow  coast_turn_coeff  is  used  to  compute  the  cosine  of  the  maximum 
allowed  turn  angle  in  each  axis  for  the  tow  missile  during  unpowered  f  ig 
[coast]  using  the  CSU  missile_util_cos_coeff,  and  called  by  the  CbU 
missilejowjly.  The  CSU  missile_util_cos_coeff  uses  the  Newton-Raphson 
method  to  evaluate  the  polynomial  with  inputs  of  missile  pointer,  coefficient 

array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum 
allowed  turn  angles  in  each  direction.  The  equations  used  are 
different  before  and  after  motor  burnout. 

/V 

if  (time  <  TOW_BURNOUT_TIME) 

{  _ _ _ _ 
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mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time); 

} 

else 

{ 

mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time); 


See  APPENDIX  L  for  a  complete  source  code  listing. 

3.29  Adat_miss_char 

I 

The  adat_miss_char  array  consists  of  characteristics  and  parameters 
describing  an  ADAT  missile  system  and  its  performance  constraints. 

3.29.1  ADAT_BURNOUT_TIME 

ADAT_BURNOUT_TIME  is  a  constant  defining  the  time  of  powered  flight 
for  the  adat  missile  in  ticks. 

3.29.1.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_adat_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_adat_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.29.  -  ADAT  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  ADAT_BURNOUT_TIME  adat_miss_char[  0] 


3.29.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.29.1.2.1  Algorithm 

ADAT_BURNOUT_TIME  is  used  to  control  computation  of  the  missile 
flyout  speed  by  a  call  to  the  CSC  missile_adat_fly. 


/V 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum 

*  allowed  turn  angles  in  each  direction.  The  equations  used  are  different 
before  and  after  motor  burnout. 

/V 

if  (time  <  ADAT_BURNOUT_TIME) 

mptr->speed  =  missile_util_eval_poly  (ADAT_BURN_SPEED_DEG, 
adat_burn_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

ADAT_BURN_TURN_DEG,  adat_burn_turn_coeff,  time); 

} 

'else 

{ 

mptr->speed  =  missile_util_eval_poly  (ADAT_COAST_SPEED_DEG, 
adat_coast_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

ADAT_COAST_TURN_DEG,  adat_coast_turn_coeff,  time); 

} 


See  APPENDIX  E  for  a  complete  source  code  hsting. 

3.29.2  ADAT_MAX_FLIGHT_TIME 

ADAT_MAX_FLIGEIT_TIME  is  a  constant  defining  the  maximum  flight 
time  for  the  adat  missile  in  ticks. 

3.29.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_adat_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_adat_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.29.  -  ADAT  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  ADAT_MAX_FLIGHT_TIME  adat_miss_char[  1] 
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3.29.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.29.2.2.1  Algorithm 

ADAT_MAX_FLIGHT_TIME  is  used  to  initialize  the  maximum  flight  time 
for  an  individual  adat  missile  by  a  call  to  the  CSU  missile_adat_init. 


for  (i  =  0;  i  <  num_missiles;  i++) 

{ 

adat_array[i].mptr.state  =  ADAT_FREE; 
adat_array[i].mptr.max_flight_time  =  ADAT_MAX_FLIGHT_TIME; 
adat_array[i].mptr.max_turn_directions  =  1; 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.29.3  INVEST_DIST_SQ 

INVEST_DIST_SQ  is  a  constant  defining  the  area  at  a  maximum  speed  of  less 
than  100  meters/second. 

3.29.3.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_adat_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_adat_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.29.  -  ADAT  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  INVEST_DIST_SQ  adat_miss_char[  2] 


3.29.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.29.3.2.1  Algorithm 

INVEST_DIST_SQ  is  used  to  compute  detonation  of  the  proximity  fuze  by  a 
call  to  the  CSU  missile_fuze_prox  in  the  CSU  missle_adat_fly. 
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*  If  the  missile  successfully  flev/,  process  the  proximity  fuze. 

/V 

missile_fuze_prox  (mptr,  MSL_TYPE_MISSILE,  aptr->target_flag, 
&(aptr->target_vehicleJdX  &(aptr->pptr),  vehjist, 
INVEST_DIST_SQ,  aptr->fuze_dist_sq); 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.29.4  HELO_FUZE_DIST_SQ 

HELO_FUZE_DIST_SQ  is  a  constant  defining  the  square  of  the  radius  of  the 
cylinder  describing  the  proximity  fuze  area  for  a  target  setting  of  type  HELO. 

3.29.4.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_adat_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_adat_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.29.  -  AD  AT  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  HELO_FUZE_DIST_SQ  adat_miss_char[  3] 


3.29.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.29.4.2.1  Algorithm 

HELO_FUZE_DIST_SQ  is  used  to  compute  the  fuze  distance  for  the  missile 
target  setting  by  a  call  to  the  CSC  missile_adat_fire. 


/V 

*  Set  fuze  distance  and  fuze  target  according  to  missile  target 

*  setting.  Set  network  variables. 

/V 

switch  (target_type) 

{ 

case  ADAT_TGT_GND: 
aptr->fuze_dist_sq  =  0.0; 

aptr->target_flag  =  PROX_FUZE_ON_NO_VEH; 
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break; 

case  ADAT_TGT_HELO: 

aptr->fuze_dist_sq  =  HELO_FUZE_DIST_SQ; 
if  (aptr->target_vehicle_id.vehicle  ==  vehicleirrelevant) 
aptr->target_flag  =  PROX_FUZE_ON_ALL_VEH; 

else 

aptr->targetjlag  =  PROX_FUZE_ON_ONE_VEH; 
break; 

case  ADAT_TGT_AIR: 

aptr->fuze_dist_sq  =  AIR_FUZE_DIST_SQ; 
if  (aptr->target_vehicle_id. vehicle  ==  vehicleirrelevant) 
aptr->target_flag  =  PROX_FUZE_ON_ALL_VEH; 

else 

aptr->target_flag  =  PROX_FUZE_ON_ONE_VEH; 
break; 
default: 

aptr->fuze_dist_sq  =  0.0; 

aptr->target_flag  =  PROX_FUZE_ON_NO_VEH; 
printf  ("MISS_ADAT:  Unknown  target  type  %d\n",  target_type); 
'  break; 

} 


The  fuze_dist_sq  is  used  to  compute  the  proximity  fuze  by  a  call  to  the  CSU 
missile_fuze_prox  in  the  CSU  missile_adat_fly. 


/V 

If  the  missile  successfully  flew,  process  the  proxinaity  fuze. 

/V 

missile_fuze_prox  (mptr,  MSL_TYPE_MISSILE,  aptr->target_flag, 
&(aptr->target_vehicle_id),  &(aptr->pptr),  vehjist, 
INVEST_DIST_SQ,  aptr->fuze_dist_sq); 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.29.5  AIR_FUZE_DIST_SQ 

AIR_FUZE_DIST_SQ  is  a  constant  defining  the  square  of  the  radius  of  the 
cylinder  describing  the  proximity  fuze  area  for  a  target  setting  of  type  AIR. 

3.29.5.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_adat_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_adat_init  is 
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normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.29.  -  AD  AT  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  AIR_FUZE_DIST_SQ  adat_miss_char[  4] 


3.29.5.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.29.5.2.1  Algorithm 

AIR  FUZE_DIST_SQ  is  used  to  compute  the  fuze  distance  for  the  missile 
target  setting  by  a  call  to  the  CSC  missile_adat_fire. 


/V 

t  Set  fuze  distance  and  fuze  target  according  to  missile  target 
*  setting.  Set  network  variables. 

/V 

switch  (target_type) 

{ 

case  ADAT_TGT_GND: 
aptr->fuze_dist_sq  =  0.0; 

aptr->target_flag  =  PROX_FUZE_ON_NO_VEH; 
break; 

case  ADAT_TGT_EIELO: 

aptr->fuze_dist_sq  =  HELO_FUZE_DIST_SQ; 
if  (aptr->target_vehicle_id.vehicle  ==  vehiclelrrelevant) 
aptr->target_flag  =  PROX_FUZE_ON_ALL_VEH; 
else 

aptr->target_flag  =  PROX_FUZE_ON_ONE_VEH; 
break; 

case  ADAT_TGT_AIR: 

aptr->fuze_dist_sq  =  AIR_FUZE_DIST_SQ; 
if  (aptr->target_vehicle_id. vehicle  ==  vehiclelrrelevant) 
aptr->target_flag  =  PROX_FUZE_ON_ALL_VEH; 
else 

aptr->target_flag  =  PROX_FUZE_ON_ONE_VEH; 
break;  _ _ _ _ 
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default: 

aptr->fuze_dist_sq  =  0.0; 

aptr->target_flag  =  PROX_FUZE_ON_NO_VEH; 
printf  ("MISS_ADAT:  Unknown  target  type  %d\n",  target_type); 
break; 

} 


The  fuze_dist_sq  is  used  to  compute  the  proximity  fuze  by  a  call  to  the  CSU 
missile_fuze_prox  in  the  CSU  missile_adat_fly. 


If  the  missile  successfully  flew,  process  the  proximity  fuze. 

/V 

missile_fuze_prox  (mptr,  MSL_TYPE_MISSILE,  aptr->target_flag, 
&(aptr->target_vehiclejd),  &(aptr->pptr),  vehjist, 
INVEST_DIST_SQ,  aptr->fuze_dist_sq); 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.29.6  ADAT_TEMP_BIAS_TIME 

ADAT_TEMP_BIAS_TIME  is  a  constant  defining  the  time  of  temporal  bias 
for  the  adat  missile  in  ticks. 

3.29.6.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_adat_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_adat_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.29.  -  ADAT  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  ADAT_TEMP_BIAS_TIME  adat_miss_char[  5] 


3.29.6.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.29.6.2.1  Algorithm 

ADAT_TEMP_BIAS_TIME  is  used  to  compute  the  bias  for  the  adat  missile  by 
a  call  to  the  CSC  missile_adat_fly. 
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/V 

*  Find  the  target  point,  etc. 

1*1 

if  ((mptr->state  ==  ADAT_GUIDE)  I  I  (mptr->state  —  ADAT_CLOSE)) 

{ 

if  ((time  <  ADAT_TEMP_BIAS_TIME)  &&  (mptr->state  == 

ADAT_GUIDE)) 

{ 

bias  =  missile_util_eval_poly  (ADAT_TEMP_BIAS_DEG, 
adat_temp_bias_coeff,  time); 
if  (((tube  H)*T)  ==  tube) 

missile_targetJos_bias  (mptr,  sightjocation, 
loc_sight_to_world,  -bias,  bias); 

else 

missile_targetJos_bias  (mptr,  sightjocation, 
loc_sight_to_world,  bias,  bias); 

} 

'  else 

missile_targetJos  (mptr,  sightjocation,  loc_sight_to_world); 

} 

else  if  (mptr->state  ==  ADAT_UNGUIDE) 
missilejarget_unguided  (mptr); 
else 

printf  ("MISSILE_ADAT:  disallowed  missile  state  %d\n",  mptr->state); 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.29.7  CLOSE_RANGE 

CLOSE_RANGE 

3.29.7.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_adatjnit, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_adatjnit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.29.  -  AD  AT  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  CLOSE_RANGE  adat_miss_char[  6] 
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Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.29.7.2.1  Algorithm 

CLOSE  RANGE  is  used  to  control  the  initial  orientation  of  the  adat  missile 
by  a  call  to  the  CSC  missile_adatjire. 


*  Set  the  initial  time,  location,  orientation,  and  speed  of  the  generic 
=*■  missile. 

/V 

mptr->time  =  0.0; 

vec_copy  (launch_point,  mptr->location); 
if  (range_to_intercept  <  CLOSE_RANGE) 

mat_copy  (loc_sight_to_world,  mptr->orientation); 

else 
'  { 

if  (((tube  /  2)  *  2)  ==  tube) 

mat_mat_mul  (tube_C_sight_left,  loc_sight_to_world, 
mptr->orientation); 

else 

mat_mat_mul(tube_C_sight_right,  loc_sight_to_world, 
mp  tr->  orienta  tion) ; 

mptr->speed  =  missile_util_eval_poly  (ADAT_BURN_SPEED_DEG, 
adat_burn_speed_coeff,  0.0)  +  launch_speed; 
mptr->init_speed  =  launch_speed; 


CLOSE_RANGE  is  used  to  control  the  state  of  guidance  for  the  adat  missile  by 
a  call  to  the  CSC  missile_adat_fire. 


If  all  was  successful,  put  any  flying  missiles  in  an  unguided  state 
and  put  this  missile  in  a  guided  state. 

/V 

for  (i  =  0;  i  <  num_adats;  i+-i-) 

if  ((adat_array[i].mptr.state  ==  ADAT_GLnDE)  I  I 
(adat_array[i].mptr.state  ==  ADAT_CLOSE)) 
adat_array[i].mptr. state  =  ADAT_UNGUIDE; 

}  _ _ _ _ 
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if  (range_to_intercept  <  CLOSE_RANGE) 
mptr->state  =  ADAT_CLOSE; 
else 

mptr->state  =  ADAT_GUIDE; 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.30  Adat_miss_poly_deg 

The  adat_miss_poly_deg  array  consists  of  values  of  the  degree  of  each 
polynomial  equation  used  to  compute  the  burn  speed,  the  coast  speed, 
maximum  cosines  of  turns  while  powered,  maximum  cosines  of  turns  while 
unpowered,  and  temporal  bias  for  the  ADAT  missile. 

3.30.1  ADAT_BURN_SPEED_DEG 

ADAT_BURN_SPEED_DEG  is  a  constant  defining  the  polynomial  degree  for 
ADAT  missile  burn  speed  coefficient  data  array.  ADAT_BURN_SPEED_DEG 
is  the  first  element  of  the  adat_miss_poly_deg. 

3.30.1.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_adat_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_adat_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.30.  -  ADAT  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  constants  data. 


#define  ADAT_BURN_SPEED_DEG  adat_miss_poly_deg[  0] 


3.30.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  ADAT_BURN_SPEED_DEG  is  9,  especially,  the  declared  size  of  the 
adat_burn_speed_coeff  is  10. 

3.30.1.2.1  Algorithm 

ADAT_BURN_SPEED_DEG  is  used  to  compute  the  ADAT  missile  speed  at 
launch  using  the  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missile_adat_fire.  The  CSU  missile_utiLeval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 
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/V 

*  Set  the  initial  time,  location,  orientation,  and  speed  of  the  generic 

*  missile. 

/V 

mptr->time  =  0.0; 

vec_copy  (launch_point,  mptr->location); 
if  (range_to_intercept  <  CLOSE_RANGE) 

mat_copy  (loc_sight_to_world,  mptr->orientation); 

else 

{ 

if  (((tube  /  2)*  2)  ==  tube) 

mat_mat_mul  (tube_C_sight_left,  loc_sight_to_world, 
mptr->orientation); 

else 

mat_mat_mul(tube_C_sight_right,  loc_sight_to_world, 
mp  tr->  or  ienta  tion); 

} 

mptr->speed  =  missile_util_eval_poly  (ADAT_BURN_SPEED_DEG, 

'  adat_burn_speed_coeff,  0.0)  +  launch_speed; 
mptr->init_speed  =  launch_speed; 

ADAT_BURN_SPEED_DEG  is  used  to  compute  the  ADAT  missile  speed 
during  powered  flight  [burn]  using  the  CSU  missile_util_eval_poly,  and 
called  by  the  CSU  missile_adat_fly.  The  CSU  missile_util_eval_poly  uses 
the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 

*  turn  angles  in  each  direction.  The  equations  used  are  different  before  and 

*  after  motor  burnout. 

/V 

if  (time  <  ADAT_BURNOUT_TIME) 

{ 

mptr->speed  =  missile_util_eval_poly  (ADAT_BURN_SPEED_DEG, 
adat_burn_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly( 
ADAT_BURN_TURN_DEG, 
adat_burn_turn_coeff,  time); 

} 

else 

{  _ _ 
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inptr->speed  =  missile_util_eval_poly  (ADAT_COAST_SPEED_DEG, 
adat_coast_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly( 
ADAT_COAST_TURN_DEG, 
adat_coast_turn_coeff,  time); 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.30.2  ADAT_COAST_SPEED_DEG 

ADAT_COAST_SPEED_DEG  is  a  constant  defining  the  polynomial  degree 
for  adat  missile  coast  speed  coefficient  data  array. 
ADAT_COAST_SPEED_DEG  is  the  second  element  of  the 
adat_miss_poly_deg. 

3.30.2.1  Initialization 

Ttre  constant  is  initialized  during  execution  of  the  CSU  missile_adat_init, 
called  by  CSC  weapons_mit.  Execution  of  the  CSU  missile_adat_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.30.  -  ADAT  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  constants  data. 


#define  ADAT_COAST_SPEED_DEG  adat_miss_poly_deg[  1] 


3.30.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  ADAT_COAST_SPEED_DEG  is  9,  especially,  the  declared  size  of  the 
adat_coast_speed_coeff  is  10. 

3.30.2.2.1  Algorithm 

ADAT_COAST_SPEED_DEG  is  used  to  compute  the  ADAT  missile  speed 
during  unpowered  flight  [coast]  using  the  CSU  missile_util_eval_poly,  and 
called  by  the  CSU  missile_adatjly.  The  CSU  missile_util_eval_poly  uses 
the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 
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*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 
turn  angles  in  each  direction.  The  equations  used  are  different  before  and 
after  motor  burnout. 

/V 

if  (time  <  ADAT_BURNOUT_TIME) 

mptr->speed  =  missile_util_eval_poly  (ADAT_BURN_SPEED_DEG, 
adat_burn_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missiie_util_eval_poly( 
ADAT_BURN_TURN_DEG, 
adat_burn_turn_coeff,  time); 

} 

else 

mptr->speed  =  missile_util_eval_poly  (ADAT_COAST_SPEED_DEG, 
adat_coast_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly( 

.  ADAT_COAST_TURN_DEG, 

adat_coast_turn_coeff,  time); 

} 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.30.3  ADAT_BURN_TURN_DEG 

ADAT_BURN_TURN_DEG  is  a  constant  defining  the  polynomial  degree  for 
the  adat  missile  maximum  cosine  of  turn  angle,  burn  turn  coefficient  data 
array.  ADAT_BURN_TURN_DEG  is  the  third  element  of  the 
adat_miss_poly_deg. 


3.30.3.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_adat_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_adat_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.30.  -  ADAT  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  constants  data. 


#define  ADAT_BURN_TURN_DEG  adat_miss_poly_deg[  2] 
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3.30.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  ADAT_BURN_TURN_DEG  is  9,  especially,  the  declared  size  of  the 
adat_burn_turn_coeff  is  10. 

3.30.3.2.1  Algorithm 

ADAT_BURN_TURN_DEG  is  used  to  compute  cosine  of  the  maximum 
allowed  turn  angle  for  the  AD  AT  missile  during  powered  flight  [burn]  using 
the  CSU  missile_util_eval_poly,  and  called  by  the  CSU  missile_adat_fly. 
The  CSU  missile_util_eval_poly  uses  the  Newton-Raphson  method  to 
evaluate  the  polynomial  with  inputs  of  degree  of  polynomial,  coefficient 
array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  ma>dmum  allowed 
turn  angles  in  each  direction.  The  equations  used  are  different  before  and 
after  motor  burnout. 

/V 

if  (time  <  ADAT_BURNOUT_TTME) 

mptr->speed  =  missile_util_eval_poly  (ADAT_BURN_SPEED_DEG, 
adat_burn_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly( 
ADAT_BURN_TURN_DEG, 
adat_burn_turn_coeff,  time); 

} 

else 

mptr->speed  =  missile_util_eval_poly  (ADAT_COAST_SPEED_DEG, 
adat_coast_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly( 
ADAT_COAST_TURN_DEG, 
adat_coast_turn_coeff,  time); 

} 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.30.4  ADAT_COAST_TURN_DEG 

ADAT_COAST_TURN_DEG  is  a  constant  defining  the  polynomial  degree 
for  the  adat  missile  maximum  cosine  of  turn  angle,  coast  turn  coefficient  data 
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array.  ADAT_COAST_TURN_DEG  is  the  fourth  element  of  the 
adat_miss_poly_deg. 

3.30.4.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_adat_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_adat_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.30.  -  ADAT  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  constants  data. 


#define  ADAT_COAST_TURN_DEG  adat_miss_poly_deg[  3] 


3.30.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  ADAT_COAST_TURN_DEG  is  9,  especially,  the  declared  size  of  the 
adat_coast_turn_coeff  is  10. 

3.30.4.2.1  Algorithm 

ADAT_COAST_TURN_DEG  is  used  to  compute  the  cosine  of  the  maximum 
allowed  turn  angle  for  the  ADAT  missile  during  unpowered  flight  [coast] 
using  the  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missile_adat_fly.  The  CSU  missile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


/V 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 

*  turn  angles  in  each  direction.  The  equations  used  are  different  before  and 
after  motor  burnout. 

/V 

if  (time  <  ADAT_BURNOUT_TIME) 

{ 

mptr->speed  =  missile_util_eval_poly  (ADAT_BURN_SPEED_DEG, 
adat_burn_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly( 
ADAT_BURN_TURN_DEG, 
adat_burn_turn_coeff,  time); 

} 

else 

(  _  _ 
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inptr->speed  =  missile_util_eval_poly  (ADAT_COAST_SPEED_DEG, 
adat_coast_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly( 
ADAT_COAST_TURN_DEG, 
adat  coast_turn_coeff,  time); 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.30.5  ADAT_TEMP_BIAS_DEG 

ADAT_TEMP_BIAS_DEG  is  a  constant  defining  the  polynomial  degree  for 
the  adat  missile  temporal  bias  coefficient  data  array 

3.30.5.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_adat_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_adat_init  is 
n,ormally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.30.  -  ADAT  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  constants  data. 


#define  ADAT_TEMP_BIAS_DEG  adat_miss_poly_deg[  4] 


3.30.5.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  ADAT_TEMP_BIAS_DEG  is  9,  especially,  the  declared  size  of  the 
adat_coast_turn_coeff  is  10. 

3.30.5.2.1  Algorithm 

ADAT_TEMP_BIAS_DEG  is  used  to  compute  the  temporal  bias  applied  to 
the  target  location  using  the  CSU  missile_util_eval_poly,  and  called  by  the 
CSU  missile_adat_fly.  The  CSU  missile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


/V 

Find  the  target  point,  etc. 

/V 

if  ((mptr->state  ==  ADAT_GUIDE)  I  I  (mptr->state  ==  ADAT_CLOSE)) 

{  _ _ _ _ _ _ _ 


-265- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


if  ((time  <  ADAT_TEMP_BIAS_TIME)  &&  (mptr->state  == 

ADAT_GUIDE)) 

{ 

bias  =  missile_util_eval_poly  (ADAT_TEMP_BIAS_DEG, 
adat_temp_bias_coeff,  time); 
if  (((tube  /  2)  2)  ==  tube) 

missile_target_los_bias  (mptr,  sightjocation, 
loc_sight_to_world,  -bias,  bias); 

else 

missile_target_los_bias  (mptr,  sightjocation, 
loc_sight_to_world,  bias,  bias); 

} 

else 

missile_target_los  (mptr,  sight_location,  loc_sight_to_world); 

} 

else  if  (mptr->state  ==  ADAT_UNGUIDE) 
missile_target_imguided  (mptr); 
else 

printf  ("MISSILE_ADAT:  disallowed  missile  state  %d\n",  mptr->state); 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.31  Adat_burn_speed_coeff 

The  adat_burn_speed  array  consists  of  the  coefficients  for  a  polynomial 
equation  defining  the  ADAT  missile  burn  speed  with  respect  to  time  in  the 
form  using  the  Newton-Raphson  method. 

3.31.1  Initialization 

The  adat_burn_speed  array  is  initialized  during  execution  of  the  CSU 
missile_adat_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_adat_init  is  normally  done  ortly  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.31.  -  ADAT  Missile  Burn  Speed 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 

The  following  is  the  default  declaration. 


/V 

*  Coefficients  for  the  speed  polynomial  before  motor  burnout. 

/V 

static  REAL  adat_burn_speed_coeff[10]  = 

{ 
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2.296, 

/*  a  Q-  m/tick  */ 

0.72990856, 

/*  a  \  -  m/tick=^=^2  */ 

0.013310932, 

/*a_2-  m/tick’^’^3  V 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0 

}; 

The  array  has  a  maximum  size  of  10  elements. 


3.31.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
ADAT_BURN_SPEED_DEG  determines  the  number  of  elements  of  the  array 
to  be  used  in  the  polynomial  evaluation. 

t 

3.31.2.1  Algorithm 

The  adat_burn_speed_coeff  array  is  used  to  initialize  the  tube  to  sight 
transformation  matrices  by  a  call  to  the  CSU  missile_adat_init. 


/V 

Initialize  the  tube  to  sight  transformation  matrices. 

/*/ 

mag  =  sqrt  (adat_burn_speed_coeff[0]  *  adat_burn_speed_coeff[0]  + 
2.0  adat_temp_bias_coeff[0]  *  adat_temp_bias_coeff[0]); 
tube_C_sight_right[l][0]  =  adat_temp_bias_coeff[0]  /  mag; 
tube_C_sight_right[l][l]  =  adat_burn_speed_coeff[0]  /  mag; 
tube_C_sight_right[l][2]  =  adat_temp_bias_coeff[0]  /  mag; 
mag  =  sqrt  (tube_C_sight_right[l][0]  *  tube_C_sight_right[l][0]  + 
tube_C_sight_right[l][l]  tube_C_sight_right[l][l]); 
tube_C_sight_right[0][0]  =  tube_C_sight_right[l][l]  /  mag; 
tube_C_sight_right[0][l]  =  -tube_C_sight_right[l][0]  /  mag; 
tube_C_sight_right[0][2]  =  0.0; 

tube_C_sight_right[2][0]  =  tube_C_sight_right[l][2] 
tube_C_sight_right[0]  [1]; 

tube_C_sight_right[2][l]  =  -tube_C_sight_right[l][2] 
tube_C_sight_right[0]  [0]; 
tube_C_sight_right[2][2]  =mag; 
mat_copy  (tube_C_sight_right,  tube_C_sight_left); 
tube_C_sight_left[0][l]  =  -tube_C_sightJeft[0][l];  _ 
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tube_C_sight_left[l][0]  =  -tube_C_sight_left[l][0]; 
tube_C_sight_left[2][0]  =  -tube_C_sight_left[2][0]; 


The  adat_burn_speed_coeff  array  is  used  to  compute  the  initial  speed  at 
launch  of  the  AD  AT  missile  using  the  CSU  missile_util_eval_poly,  and 
called  by  the  CSU  missile_adat_fire.  The  CSU  missile_util_eval_poly  uses 
the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 


mptr->speed  =  missile_util_eval_poly  (ADAT_BURN_SPEED_DEG, 
adat_burn_speed_coeff,  0.0)  +  launch_speed; 


The  adat_burn_speed_coeff  array  is  used  to  compute  the  ADAT  missile  speed 
during  powered  flight  [burn]  using  the  CSU  missile_util_eval_poly,  and 
called  by  the  CSU  missile_adat_fly.  The  CSU  missile_util_eval_poly  uses 
the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 
turn 

angles  in  each  direction.  The  ecjuations  used  are  different  before  and 

*  after  motor  burnout. 

/*/ 

if  (time  <  ADAT_BURNOUT_TIME) 

mptr->speed  =  missile_util_eval_poly  (ADAT_BURN_SPEED_DEG, 
adat_burn_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

ADAT_BURN_TURN_DEG, 
adat_burn_turn_coeff,  time); 

} 

else 

mptr->speed  =  missile_util_eval_poly  (ADAT_COAST_SPEED_DEG, 
adat_coast_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

ADAT_COAST_TURN_DEG, 
adat_coast_turn_coeff,  time); 

} 
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See  APPENDIX  E  for  a  complete  source  code  listing. 

3.32  Adat_coast_speed_coeff 

This  data  array  consists  of  the  coefficients  for  a  polynomial  equation  defining 
the  ADAT  missile  coast  speed  with  respect  to  time  in  the  form  using  the 
Newton-Raphson  method. 

3.32.1  Initialization 

The  adat_coast_speed  array  is  initialized  during  execution  of  the  CSU 
missile_adat_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_adat_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.32.  -  ADAT  Missile  Coast  Speed 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 

The  following  is  the  default  declaration. 


1*1 

*  Coefficients  for  the  speed  polynomial  after  motor  burnout. 
1*1 


static  REAL  adat_coast_speed_coeff[10]  = 

{ 


105.52162, 

-1.0157285, 

5.6124330e-3, 

-1.6262608e-5, 

1.8991982e-8, 

0.0, 

0.0, 

0.0, 

0.0, 


I*  a_0  -  m/tick  *! 

!*  a_l  -  m/tick'^*2  */ 
/*  a_2  -  m/ tick**3  */ 
/*  a_3  -  m/tick**4  */ 
/*  a_4  -  m/tick**5  */ 


0.0 


The  array  has  a  maximum  size  of  10  elements. 

3.32.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
ADAT_COAST_SPEED_DEG  determines  the  number  of  elements  of  the 
array  to  be  used  in  the  polynomial  evaluation. 
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3.32.2.1  Algorithm 

The  adat_coast_speed_coeff  array  is  used  to  compute  the  ADAT  missile  speed 
during  unpowered  flight  [coast]  using  the  CSU  missile_util_eval_poly,  and 
called  by  the  CSU  missile_adat_fly.  The  CSU  missile_util_evaLpoly  uses 
the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 


/V 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 
turn 

*  angles  in  each  direction.  The  equations  used  are  different  before  and 
after  motor  burnout. 

/V 

if  (time  <  ADAT_BURNOUT_TIME) 

{ 

mptr->speed  =  missile_util_eval_poly  (ADAT_BURN_SPEED_DEG, 
adat_burn_speed_coeff,  time)  +  mptr->init_speed; 

«  mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

ADAT_BURN_TURN_DEG, 
adat_burn_turn_coeff,  time); 

} 

else 

{ 

mptr->speed  =  missile_util_eval_poly  (ADAT_COAST_SPEED_DEG, 
adat_coast_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

ADAT_COAST_TURN_DEG, 
adat_coast_turn_coeff,  time); 

} 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.33  Adat_burn_turn_coeff 

The  adat_burn_turn_coeff  array  consists  of  the  coefficients  for  a  polynomial 
equation  defining  the  ADAT  missile  maximum  cosine  of  turn  while  powered 
with  respect  to  time  in  the  form  using  the  Newton-Raphson  method. 

3.33.1  Initialization 

The  adat_burn_turn  array  is  initialized  during  execution  of  the  CSU 
missile_adat_init,  called  by  CSC  weaponsjnit.  Execution  of  the  CSU 
missile_adat_init  is  normally  done  only  once  during  CSCI  initialization  and 
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is  performed  sequentially.  See  TABLE  5.1.33.  -  ADAT  Missile  Burn  Turn 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 


The  following  is  the  default  declaration. 


*  Coefficients  for  the  cosine  of  max  turn  polynomial  before  motor  burnout. 


/V 


static  REAL  adat_burn_turn_coeff[10]  = 


{ 

0.999993, 

-6.2386917e-7, 

1.6146426e-7, 

-9.720142e-7, 

0.0, 

0.0, 

0.0, 

'0.0, 

0.0, 

0.0 


I*  a_0  -  cos(rad)/tick  V 
I*  a_l  -  cos(rad)/tick**2  *! 
I*  a_2  -  cos(rad)/tick*’^3  V 
I*  a_3  -  cos(rad)/tick*M  *! 


}; 


The  array  has  a  maximum  size  of  10  elements. 


3.33.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
ADAT_BURN_TURN_DEG  determines  the  number  of  elements  of  the  array 
to  be  used  in  the  polynomial  evaluation. 

3.33.2.1  Algorithm 

The  adat_burn_turn_coeff  array  is  used  to  compute  the  cosine  of  the 
maximum  allowed  turn  angle  of  the  ADAT  missile  speed  during  powered 
flight  [burn]  using  the  CSU  missile_utii_eval_poly,  and  called  by  the  CSU 
missile_adat_fly.  The  CSU  missile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 
turn  _ _ _ _ _ _ _ 
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*  angles  in  each  direction.  The  equations  used  are  different  before  and 
after  motor  burnout. 

/V 

if  (time  <  ADAT_BURNOUT_TIME) 

mptr->speed  =  missile_util_eval_poly  (ADAT_BURN_SPEED_DEG, 
adat_burn_speed_coeff,  time)  +  mptr->iniLspeed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

ADAT_BURN_TURN_DEG, 
adat_burn_turn_coeff,  time); 

} 

else 

mptr->speed  =  missile_util_eval_poly  {ADAT_COAST_SPEED_DEG, 
adat_coast_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

ADAT_COAST_TURN_DEG, 
adat_coast_turn_coeff,  time); 

} 

I  t 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.34  AdaUcoast_turn_coeff 

This  data  array  consists  of  the  coefficients  for  a  polynomial  equation  defining 
the  ADAT  missile  maximum  cosine  of  turn  while  unpowered  with  respect  to 
time  in  the  form  using  the  Newton-Raphson  method. 

3.34.1  Initialization 

The  adat_coast_turn  array  is  initialized  during  execution  of  the  CSU 
missile_adat_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_adat_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.34.  -  ADAT  Missile  Coast  Turn 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 

The  following  is  the  default  declaration. 


/V 

*  Coefficients  for  the  cosine  of  max  turn  polynomial  after  motor  burnout. 

/V 

static  REAL  adat_coast_turn_coeff[10]  = 

{  _ _ _ 
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0.99753111, 

/*  a_0  -  cos(rad)/tick  */ 

5.5817986e-5, 

!*  a_l  -  cos(rad)/ tick**2  */ 

-5.1276276e-7, 

!*  a_2  -  cos(rad)/tick*’^3  */ 

2.2388593e-9, 

/*  a_3  -  cos(rad)/tick*M  */ 

-5.1964622e-12, 

/*  a_4  -  cos(rad)/tick**5  */ 

4.5499104e-15, 

/*  a_5  -  cos(rad)/tick**6  */ 

0.0, 

0.0, 

0.0, 

0.0 

}; 

The  array  has  a  maximum  size  of  10  elements. 

3.34,2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
ADAT_COAST_TURN_DEG  determines  the  number  of  elements  of  the 
aBray  to  be  used  in  the  polynomial  evaluation. 

3.34.2.1  Algorithm 

The  adat_coast_turn_coeff  array  is  used  to  compute  the  cosine  of  the 
maximum  allowed  turn  angle  of  the  ADAT  missile  speed  during  unpowered 
flight  [coast]  using  the  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missile_adat_fly.  The  CSU  missile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


/V 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 
turn 

*  angles  in  each  direction.  The  equations  used  are  different  before  and 

*  after  motor  burnout. 

/V 

if  (time  <  ADAT_BURNOUT_TTME) 

{ 

mptr->speed  =  missile_util_eval_poly  (ADAT_BURN_SPEED_DEG, 
adat_burn_speed_coeff,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_utii_eval_poly  ( 

ADAT_BURN_TURN_DEG, 
adat_burn_turn_coeff,  time); 

} 

else 
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mptr->speed  =  missile_util_eval_poly  (ADAT_COAST_SPEED_DEG, 
adat_coast_speed_coefL  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

ADAT_COAST_TURN_DEG, 
adat_coast_turn_coeff,  time); 

} 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.35  Adat_temp_bias_coeff 

The  adat_temp_bias_coeff  array  consists  of  the  coefficients  for  a  polynomial 
equation  defining  the  ADAT  missile  temporal  bias  with  respect  to  time  in  the 
form  using  the  Newton-Raphson  method. 

3.35.1  Initialization 

T^e  adat_temp_bias_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_adat_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_adat_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.35.  -  ADAT  Missile  Temporal  Bias 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 

The  following  is  the  default  declaration. 


/V 

Coefficients  for  the  temporial  bias  polynomial. 

/V 

static  REAL  adat_temp_bias_coeff[10]  = 

{ 


5.3105657e-2, 

!*  a_0  -  m 

7.l795817e-2, 

!*  a_l  -  m/tick  *! 

1.8084646e-2, 

!*  a_2  -  m/tick*’^2  */ 

-6.0083762e-4, 

/*  a_3  -  m/tick**3  */ 

4.6761091e-6, 

/*  a_4  -  m/ tick*'’^4  */ 

0.0, 

0.0, 

0.0, 

0.0, 

0.0 

}; 
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The  array  has  a  maximum  size  of  10  elements. 

3.35.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
ADAT  TEMP_BIAS_DEG  determines  the  number  of  elements  of  the  array  to 
be  used  in  the  polynomial  evaluation. 

3.35.2.1  Algorithm 

The  adat_temp_bias_coeff  array  is  used  to  initialize  the  tube  to  sight 
transformation  matrices  by  a  call  to  the  CSU  missile_adat_init. 


/V 

Initialize  the  tube  to  sight  transformation  matrices. 

1*1 

mag  =  sqrt  (adat_burn_speed_coeff[0]  *  adat_burn_speed_coeff[0]  + 
2.0  adat_temp_bias_coeff[0]  adat_temp_bias_coeff[0]); 
tube_C_sight_right[l][0]  =  adat_temp_bias_coeff[0]  /  mag; 
tube_C_sight_right[l][l]  =  adat_burn_speed_coeff[0]  /  mag; 
tube_C_sight_right[l][2]  =  adat_temp_bias_coeff[0]  /  mag; 
mag  =  sqrt  (tube_C_sight_right[l][0]  tube_C_sight_right[l][0]  + 
tube_C_sight_right[l][l]  tube_C_sight_right[l ][!]); 
tube_C_sight_right[0][0]  =  tube_C_sight_right[l][l]  /  mag; 
tube_C_sight_right[0][l]  =-tube_C_sight_right[l][0]  /  mag; 
tube_C_sight_right[0][2]  =  0.0; 

tube_C_sight_right[2][0]  =  tube_C_sight_right[l][2] 
tube_C_sight_right[0]  [1]; 

tube_C_sight_right[2][l]  =  -tube_C_sight_right[l][2] 
tube_C_sight_right[0]  [0]; 
tube_C_sight_right[2][2]  =  mag; 
mat_copy  (tube_C_sight_right,  tube_C_sight_left); 
tube_C_sightJeft[0][l]  =  -tube_C_sight_left[0][l]; 
tube_C_sightJeft[l][0]  =  -tube_C_sight_left[l][0]; 
tube_C_sight_Ieft[2][0]  =  -tube_C_sightJeft[2][0]; 


The  adat_temp_bias_coeff  array  is  used  to  compute  the  temporal  bias  applied 
to  the  target  location  using  the  CSU  missile_util_eval_poly,  and  called  by  the 
CSU  missile_adat_fly.  The  CSU  missile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 
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/V 

Find  the  target  point,  etc. 

1*1 

if  ((mptr->state  ==  ADAT_GUIDE)  i  I  (mptr->state  ==  ADAT_CLOSE)) 

{ 

if  ((time  <  ADAT_TEMP_BIAS_TIME)  &&  (mptr->state  == 

ADAT_GUIDE)) 

{ 

bias  =  missile_util_eval_poly  (ADAT_TEMP_BIAS_DEG, 
adat_temp_bias_coeff,  time); 
if  (((tube  /  2)  *  2)  ==  tube) 

missile_target_los_bias  (mptr,  sightjocation, 
loc_sight_to_world,  -bias,  bias); 

else 

missile_target_los_bias  (mptr,  sightjocation, 
loc_sight_to_world,  bias,  bias); 

} 

else 

'  missile_targetJos  (mptr,  sightjocation,  loc_sight_to_world); 

} 

else  if  (mptr->state  ==  ADAT_UNGUIDE) 
missile_target_unguided  (mptr); 
else 

printf  ("MISSILE_ADAT:  disallowed  missile  state  %d\n",  mptr->state); 


See  APPENDIX  E  for  a  complete  source  code  listing. 

3.36  Atgm_miss_char 

The  atgm_miss_char  array  consists  of  characteristics  and  parameters 
describing  an  ATGM  missile  system  and  its  performance  constraints.  The  tow 
missile  source  code  was  used  as  the  baseline  for  the  ATGM  missile  function; 
many  of  the  ATGM  constants,  variables,  CSCs  and  CSUs  have  the  same  name 
as  in  the  TOW  missile  source  code. 

3.36.1  TOW_BURNOUT_TIME  [for  ATGM] 

TOW_BURNOUT_TIME  is  a  constant  defining  the  time  of  powered  flight  for 
ATGM  missile  in  ticks. 

3.36.1.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_atgmjnit, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_atgmjnit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
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sequentially.  See  TABLE  5.1.36.  -  ATOM  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  TOW_BURNOUT_TIME  tow_miss_char[  0] 


3.36.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.36.1.2.1  Algorithm 

TOW  BURNOUT_TIME  is  used  to  control  computation  of  the  missile  flyout 
speed"  and  the  cosines  of  the  maximum  allowed  turn  angles  in  each  direction 
by  a  call  to  the  CSC  missile_atgm_fly. 


*■  Find  the  current  missile  speed  and  the  cosines  of  the  maximum 
allowed  turn  angles  in  each  direction.  The  equations  used  are 
*  different  before  and  after  motor  burnout. 

/V 

if  (time  <  TOW_BURNOUT_TIME) 

mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time), 

} 

else 

{ 

mptr->speed  =  mptr->init_speed  + 

(speed_factor  * 

missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)); 

missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time), 

} 


See  APPENDIX  F  for  a  complete  source  code  listing. 
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3.36.2  TOW_RANGE_LIMIT_TIME  [for  ATGM] 

TOW  RANGE_LIMIT_TIME  is  a  constant  defining  the  range  limit  time  for 
the  ATGM  missile  in  ticks;  at  this  point  the  wire  is  cut,  but  the  missi  e  is 
allowed  to  fly  to  the  maximum  flight  time. 

3.36.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_atgm_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_atgm_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.36.  -  ATGM  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  TOW_RANGE_LIMIT_TIME  tow_miss_char[  1] 


3.36.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.36.2.2.1  Algorithm 

TOW  RANGE_LIMIT_TIME  is  used  to  control  the  wire  cut  at  the  maxiim^ 
range  flight  time  for  an  individual  ATGM  missile  by  a  call  to  the  CSU 
missile_atgm_fly. 


/V 

If  the  missile  has  reached  its  maximum  range  (not  the  maximum  distance 
its  allowed  to  fly),  cut  the  wire. 

/V 

if  ((time  >  TOW_RANGE_LIMIT_TIME)  &&  !tptr->wire_is_cut) 
tptr->wire_is_cut  =  TRUE; 


See  APPENDIX  F  for  a  complete  source  code  listing. 

3.36.3  TOW_MAX_FLIGHT_TIME  [for  ATGM] 

TOW_MAX_FLIGHT_TIME  is  a  constant  defining  the  maximum  flight  time 
for  the  ATGM  missile  assumed  in  ticks;  cosine  of  the  maximum  turn  angle  is 
greater  than  1.0  beyond  this  point. 
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3.36.3.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  inissile_atgrn_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_atgm_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.36.  -  ATGM  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  TOW_MAX_FLIGHT_TIME  tow_miss_char[  2] 


3.36.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.36.3.2.1  Algorithm 

TOW_MAX_FLIGHT_TIME  is  used  to  initialize  the  maximum  flight  time 
for  an  individual  ATGM  missile  by  a  call  to  the  CSU  missile_atgmjnit. 


tptr->mptr.max_flight_time  =  TOW_MAX_FLIGHT_TIME; 


See  APPENDDC  F  for  a  complete  source  code  listing. 

3.36.4  ATGM_TURN_FACTOR 

ATGM_TURN_FACTOR  is  a  constant  defining  the  ratio  of  the  ATGM  to 
TOW  missile  performance  in  turns;  ATGM  turn  factor  for  wider  turning 
capability  with  respect  to  TOW 

3.36.4.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_atgm_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_atgmjnit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.36.  -  ATGM  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  ATGM_TURN_F ACTOR  tow_miss_char[3] 
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3.36.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.36.4.2.1  Algorithm 

ATGM_TURN_FACTOR  is  used  to  modify  the  tow  burn  turn  and  tow  coast 
turn  coefficients  for  each  axis  by  a  call  to  the  CSU  missile_atgm_init. 


/*  change  turn  polynomial  coefficients  so  missile  has  larger  *! 

/*  max  turn  angle.  Since  Ph  determines  when  a  vehicle  should  be  */ 
/*  impacted,  turn  rates  should  not  effect  missile  effectiveness  */ 

for  (i=0;  i<tow_burn_turn_coeff.deg;  i++) 

{ 

tow_burn_turn_coeff.side_coeff[i]  *=  ATGM_TURN_FACTOR; 
tow_burn_turn_coeff.up_coeff[i]  *=  ATGM_TURN_F ACTOR; 
tow_burn_turn_coeff.down_coeff[i]  *=  ATGM_TURN_F ACTOR; 

} 

for  (i=0;  i<tow_coast_turn_coeff.deg;  i++) 

{ 

tow_coast_turn_coeff.side_coeff[i]  *=  ATGM_TURN_FACTOR; 
tow_coast_turn_coeff.up_coeff[i]  ATGM_TURN_FACTOR; 
tow_coast_turn_coeff.down_coeff[i]  ATGM_TURN_FACTOR; 

} 


See  APPENDIX  F  for  a  complete  source  code  listing. 

3.37  Atgm_miss_poly_deg 

The  atgm_miss_poly_deg  array  consists  of  values  of  the  degree  of  each 
polynomial  equation  used  to  compute  the  burn  speed,  the  coast  speed, 
maximum  cosines  of  turns  while  powered,  and  maximum  cosines  of  turns 
while  unpowered  for  the  ATGM  missile.  The  tow  missile  source  code  was 
used  as  the  baseline  for  the  ATGM  missile  function;  many  of  the  ATGM 
constants,  variables,  CSCs  and  CSUs  have  the  same  name  as  in  the  TOW 
missile  source  code. 

3.37.1  TOW_BURN_SPEED_DEG  [for  ATGM] 

TOW_BURN_SPEED_DEG  is  a  constant  defining  the  polynomial  degree  for 
the  ATGM  missile  burn  speed  coefficient  data  array. 
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The  constant  is  initialized  during  execution  of  the  CSU  missile_atgm_init, 
called  by  the  CSC  weapons_mit.  Execution  of  the  CSU  missile_atgin_in.it  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.37.  -  ATOM  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  constants  data. 


#define  TOW_BURN_SPEED_DEG  tow_miss_poly_deg[0] 


3.37.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  TOW_BURN_SPEED_DEG  is  4,  especially,  the  declared  size  of  the 
tow_burn_speed_coeff  is  5. 

3.37.1.2.1  Algorithm 

foW_BURN_SPEED_DEG  is  used  to  compute  the  ATGM  missile  speed  at 
launch  using  the  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missile_atgm_fire.  The  CSU  missile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


/V 

*  Set  the  initial  time,  location,  orientation,  and  speed  of  the  generic 

*  missile. 

/V 

mptr->time  =  0.0; 

vec_copy  (launch_point,  mptr->location); 
mat_copy  (loc_sight_to_world,  mptr->orientation); 
mptr->speed  =  launch_speed  + 

(speed_factor  *  missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 

tow_bum_speed_coeff,  0.0)); 
mptr->init_speed  =  launch_speed; 


TOW_BURN_SPEED_DEG  is  used  to  compute  the  ATGM  missile  speed 
during  powered  flight  [burn]  using  the  CSU  missile_util_eval_poly,  and 
called  by  the  CSU  missile_atgm_fly.  The  CSU  missile_util_eval_poly  uses 
the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 
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Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 

*  turn  angles  in  each  direction.  The  equations  used  are  different  before  and 

*  after  motor  burnout. 

/V 

if  (time  <  TOW_BURNOUT_TIME) 

mptr->speed  =  missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)  +  mptr->init_speed; 
missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time); 

} 

else 

mptr->speed  =  missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)  +  mptr->init_speed; 
missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time); 

1 

If 

See  APPENDIX  F  for  a  complete  source  code  listing. 

3.37.2  TOW_COAST_SPEED_DEG  [for  ATGM] 

TOW_COAST_SPEED_DEG  is  a  constant  defining  the  polynomial  degree  for 
ATGM  missile  coast  speed  coefficient  data  array 

3.37.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_atgm_init, 
called  by  the  CSC  weapons_init.  Execution  of  the  CSU  missile_atgm_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.37.  -  ATGM  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  array  data. 


#define  TOW_COAST_SPEED_DEG  tow_miss_poly_deg[l] 


3.37.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  TOW_COAST_SPEED_DEG  is  4,  especially,  the  declared  size  of  the 
tow_burn_speed_coeff  is  5. 
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3.37.2.2.1  Algorithm 

TOW_COAST_SPEED_DEG  is  used  to  compute  the  ATOM  missile  speed 
during  unpowered  flight  [coast]  using  the  CSU  missile_util_eval_poly,  and 
called  by  the  CSU  missile_atgm_fly.  The  CSU  missile_util_eval_poly  uses 
the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 
turn  angles  in  each  direction.  The  equations  used  are  different  before  and 
after  motor  burnout. 

/V 

if  (time  <  TOW_BURNOUT_TIME) 

mptr->speed  =  missile_util_eval_poly  {TOW_BURN_SPEED_DEC, 
tow_burn_speed_coeff,  time)  +  mptr->init_speed; 

.  missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time); 

} 

else 

mptr->speed  =  missile_util_eval_poly  (TOW_COAST_SPEED_DEC, 
tow_coast_speed_coeff,  time)  +  mptr->init_speed; 
missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time); 

1 


See  APPENDIX  F  for  a  complete  source  code  listing. 

3.37.3  TOW_BURN_TURN_DEG  [for  ATOM] 

TOW_BURN_TURN_DEC  is  a  constant  defining  the  polynomial  degree  for 
each  ATCM  missile  burn  turn  coefficient  data  sub-array  of  the  ATCM  missile 
burn  turn  coefficient  data  array  structure 

3.37.3.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_atgm_init, 
called  by  CSC  weapons_mit-  Execution  of  the  CSU  missile_atgm_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.37.  -  ATCM  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  constant  data. 
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#define  TOW_BURN_TURN_DEG  tow_miss_poly_deg[2] 


3.37.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  TOW_BURN_TURN_DEG  is  1,  especially,  the  declared  size  of  the 
tow  burn_turn_coeff  is  2.  Changing  this  constant  requires  a  recompile 
because  of  the  hard  coded  multi-dimension  characteristic. 


*  Coefficients  for  the  cosine  of  max  turn  polynomials  before  motor  burnout. 

*  The  structure  _MAX_COS_COEFF_  is  used  to  store  the  values  for  the  turn 
sideways,  up,  and  down  polynomials  along  with  their  order. 

/V 

static  MAX_COS_COEFF  tow_burn_turn_coeff  = 

f 

I*  Order  of  the  polynomials.  *! 

/*  Sidewards  turn.  *! 

0.999976868652,  /*  a_0  -  cos(rad)/tick  *! 

-3.5933955e-7  /*  a_l  -  cos(rad)/tick'"*2  *! 

}, 

{ 

I*  Upwards  turn.  *! 

0.999960667258,  I*  a_0  -  cos(rad)/tick 
-3.1492328e-6  /’"  a_l  -  cos(rad)/tick**2  *! 

{ 

I*  Downwards  turn.  * ! 

0.999978909989,  I*  a_0  -  cos(rad)/trck  *! 

-7.8194991e-9  I*  a_l  -  cos(rad)/ tick’^’^  *! 

} 


3.24.3.2.1  Algorithm 

TOW_BURN_TURN_DEG  is  hard  coded  by  type  definition  of 
MAX_COS_COEFF  and  is  used  to  compute  the  cosine  of  the  maximum 
allowed  turn  angle  in  each  axis  for  the  ATGM  missile  during  powered 
[burn]  using  the  CSU  missile_util_cos_coeff,  and  called  by  the  CSU 
missile_atgm_fly.  The  CSU  missile_util_cos_coeff  uses  the  Newton- 
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Raphson  method  to  evaluate  the  polynomial  with  inputs  of  missile  pointer, 
coefficient  array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 

*  turn  angles  in  each  direction.  The  equations  used  are  different  before  and 
after  motor  burnout. 

/V 

if  (time  <  TOW_BURNOUT_TIME) 

mptr->speed  =  missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)  +  mptr->init_speed; 
missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time); 

} 

else 

mptr->speed  =  nussile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)  +  mptr->init_speed; 

'  missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time); 

} 


See  APPENDIX  F  for  a  complete  source  code  listing. 

3.37.4  TOW_COAST_TURN_DEG  [for  ATGM] 

TOW_COAST_TURN_DEG  is  a  constant  defining  the  polynomial  degree  for 
each  ATGM  missile  coast  turn  coefficient  data  sub-array  of  the  ATGM  missile 
coast  turn  coefficient  data  array  structure 

3.37.4.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_atgm_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_atgm_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.37.  -  ATGM  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  array  data. 


#define  TOW_COAST_TURN_DEG  tow_miss_poly_deg[3] 
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3.37.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  in  each  axis  for  TOW_COAST_TURN_DEG  is  3,  especially,  the 
declared  size  of  the  tow_coast_turn_coeff  is  4.  Changing  this  constant 
requires  a  recompile  because  of  the  hard  coded  multi-dimension 
characteristic. 


*  Coefficients  for  the  cosine  of  max  turn  polynomials  after  motor  burnout. 

/V 

static  MAX_COS_COEFF  tow_coast_turn_coeff  = 

3,  /*  Order  of  the  polynomials.  */ 

{' 

I*  Sidewards  turn.  */ 

'  0.99995112518,  a_0  -  cos(rad)/tick 

8.96333e-7,  /*  a_l  -  cos(rad)/tick="’^  */ 

-5.995375e-9,  I*  cos(rad)/tick**3  *! 

1.162225e-ll  /*  a_3  -  cos(rad)/tick’^M  *! 

{ 

I*  Upwards  turn.  *! 

0.9998498495,  /  *  a_0  -  cos(rad)  /  tick 

1.657779e-6,  /*  a_l  -  cos(rad)/tick’^*2 

-8.231861e-9,  I*  a_2  -  cos(rad)/tick*’^3  *! 

1.381832e-ll  I*  a_3  -  cos(rad)/tick*M  *! 

}, 

{ 

I*  Downwards  turn.  *! 

0.9999714014,  I*  a_0  -  cos(rad)/tick  V 
3.382077e-7,  Z’'  a_l  -  cos(rad)/tick’^=^2  *! 

-1.601259e-9,  I*  a_2  -  cos(rad)/tick*’'3  *! 

2.623014e-12  /’'  a_3  -  cos(rad)/tick="M  *! 

} 

}; 


3.37.4.2.1  Algorithm 

TOW_COAST_TURN_DEG  is  hard  coded  by  type  definition  of 
MAX_COS_COEFF  and  is  used  to  compute  the  cosine  of  the  maximum 
allowed  turn  angle  in  each  axis  for  the  atgm  missile  during  unpowered  flight 
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[coast]  using  the  CSU  missile_util_cos_coeff,  and  called  by  the  CSU 
missile_atgm_fly.  The  CSU  missile_util_cos_coeff  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  missile  pointer, 
coefficient  array,  and  time. 


/V 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 
turn  angles  in  each  direction.  The  equations  used  are  different  before  and 

*  after  motor  burnout. 

/V 

if  (time  <  TOW_BURNOUT_TIME) 

{ 

mptr->speed  =  missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)  +  mptr->init_speed; 
missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time); 

} 

else 

{ 

'  mptr->speed  =  missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)  +  mptr->init_speed; 
missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time); 

} 


See  APPENDIX  F  for  a  complete  source  code  listing. 

3,38  Tow_burn_speed_coeff  [for  ATGM] 

The  tow_burn_speed_coeff  array  consists  of  the  coefficients  for  a  polynomial 
equation  defining  the  ATGM  missile  burn  speed  with  respect  to  time  in  the 
form  using  the  Newton-Raphson  method.  The  tow  missile  source  code  was 
used  as  the  baseline  for  the  ATGM  missile  function;  many  of  the  ATGM 
constants,  variables,  CSCs  and  CSUs  have  the  same  name  as  in  the  TOW 
missile  source  code. 

3.38.1  Initialization 

The  tow_burn_speed_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_atgm_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_atgm_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.38.  -  ATGM  Missile  Burn  Speed 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 

The  following  is  the  default  declaration. 
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*  Coefficients  for  the  speed  polynomial  before  motor  burnout  initialized  to 

*  default  values. 

/V 

static  REAL  tow_burn_speed_coeff[5]  = 

4.466666667,  a_0  -  m/tick  (67.0  m/sec)  V 

1.222103405,  /*  a_l  -  m/tick*’^  (274.9732662  m/ sec="’"2)  */ 

-0.024532086,  /*  a_2  -  m/tick‘'’'3  (-82.7057910  m/ sec**3)  */ 

0.0, 

0.0 

}; 


The  array  has  a  maximum  size  of  5  elements. 

3.38.2  Usage 

I 

During  real-time  execution,  this  array  is  not  recomputed. 
TOW_BURN_SPEED_DEG  determines  the  number  of  elements  of  the  array 
to  be  used  in  the  polynomial  evaluation. 

3.38.2.1  Algorithm 

Tow_burn_speed_coeff  is  used  to  compute  the  ATGM  missile  speed  at 
launch  using  the  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missile_atgm_fire.  The  CSU  missile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


/V 

*  Set  the  initial  time,  location,  orientation,  and  speed  of  the  generic 
missile. 

/V 

mptr->time  =  0.0; 

vec_copy  (launch_point,  mptr->location); 
mat_copy  (loc_sight_to_world,  mptr->orientation); 
mptr->speed  =  missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  0.0)  +  launch_speed; 
mptr->init_speed  =  launch_speed; 
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Tow_burn_speed_coeff  is  used  to  compute  the  ATOM  missile  speed  during 
powered  flight  [burn]  using  the  CSU  missile_util_eval_poly,  and  called  by 
the  CSU  missile_atgm_fly.  The  CSU  missile_util_eval_poly  uses  the 
Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree 
of  polynomial,  coefficient  array,  and  time. 


*■  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 
turn  angles  in  each  direction.  The  equations  used  are  different  before  and 
after  motor  burnout. 

/V 

if  (time  <  TOW_BURNOUT_TIME) 

mptr->speed  =  missile_util_eval_poly  (TOW_BURN_SRERD_DEG, 
tow_burn_speed_coeff,  time)  +  mptr->init_speed; 
missile  util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time), 

} 

^  else 

mptr->speed  =  missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)  +  mptr->init_speed; 
missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time), 

} 


See  APPENDIX  F  for  a  complete  source  code  listing. 

3.39  Tow_coast_speed_coeff  [for  ATGM] 

The  tow_coast_speed_coeff  array  consists  of  the  coefficients  for  a  polynomial 
equation  defining  the  ATGM  missile  coast  speed  with  respect  to  time  in  the 
form  using  the  Newton-Raphson  method.  The  tow  missile  source  code  was 
used  as  the  baseline  for  the  ATGM  missile  function;  many  of  the  ATGM 
constants,  variables,  CSCs  and  CSUs  have  the  same  name  as  in  the  TOW 
missile  source  code. 

3.39.1  Initialization 

The  tow_coast_speed_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_atgm_init,  called  by  CSC  weaponsjnit.  Execution  of  the  CSU 
missile_atgm_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.38.  -  ATGM  Missile  Coast  Speed 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 

The  following  is  the  default  declaration. 
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/V 

*  Coefficients  for  the  speed  polynomial  after  motor  burnout  initialized  to 

*  default  values. 

/V 


static  REAL  tow_coast_speed_coeff[5]  = 


21.81905383, 
-9.5382019e-2, 
2.4378222e-4, 
-2.6311  llle-7, 
0.0 


/*  a_0  -  m/tick  (327.2858074  m/sec)  */ 

/*  a_l  -  m/tick**2  (-21.4609544  m/ sec**2)  */ 
I*  a_2  -  m/tick=^=^3  (  0.8227650  m/sec^'^O)  V 
I*  a_3  -  m/tick=^M  ( -0.0133200  m/sec*M)  V 


}; 


The  array  has  a  maximum  size  of  5  elements. 

3'.39.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
TOW_COAST_SPEED_DEG  determines  the  number  of  elements  of  the  array 
to  be  used  in  the  polynomial  evaluation. 

3.39.2.1  Algorithm 

Tow_coast_speed_coeff  is  used  to  compute  the  ATGM  missile  speed 
unpowered  flight  [coast]  using  the  CSU  missile_util_eval_poly,  and  called  by 
the  CSU  missile_atgm_fly.  The  CSU  missile_util_eval_poly  uses  the 
Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree 
of  polynomial,  coefficient  array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 
turn  angles  in  each  direction.  The  equations  used  are  different  before  and 

*  after  motor  burnout. 

/V 

if  (time  <  TOW_BURNOUT_TIME) 

mptr->speed  =  missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)  +  mptr->init_speed; 
missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time); 

} 

else  - - - - 


-290- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


mptr->speed  =  missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)  +  mptr->init_speed; 
missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time); 

} 


See  APPENDIX  F  for  a  complete  source  code  listing. 

3.40  Tow_buri^_turn_coeff  [for  ATGM] 

The  tow_burn_turn_coeff  two-dimensional  array  consists  of  the  coefficients 
for  three  polynomial  equations  [sidewards,  upwards,  and  downwards 
movement]  defining  the  ATGM  missile  maximum  cosine  of  turn  while 
powered  with  respect  to  time  in  the  form  using  the  Newton-Raphson 
method.  The  tow  missile  source  code  was  used  as  the  baseline  for  the  ATGM 
missile  function;  many  of  the  ATGM  constants,  variables,  CSCs  and  CSUs 
have  the  same  name  as  in  the  TOW  missile  source  code.  A  turn  factor  is  used 
to  scale  the  TOW  coefficients  for  ATGM  performance. 

f 

3.40.1  Initialization 

The  tow_burn_turn_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_atgm_init,  called  by  CSC  weaponsjnit.  Execution  of  the  CSU 
missile_atgm_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.40.  -  ATGM  Missile  Burn  Turn 
Coefficients  Data  Array  for  a  summary  of  the  array  data. 

The  following  is  the  default  declaration. 


/V 

*  Coefficients  for  the  cosine  of  max  turn  polynomials  before  motor  burnout. 
The  structure  _MAX_COS_COEFF_  is  used  to  store  the  values  for  the  turn 

*  sideways,  up,  and  down  polynomials  along  with  their  order. 

/V 

static  MAX_COS_COEFF  tow_burn_turn_coeff  = 

{ 

1,  /*  Order  of  the  polynomials.  */ 

{ 

/*  Sidewards  turn.  */ 

0.999976868652,  /*  a_0  -  cos(rad)/tick  */ 

-3.5933955e-7  cos(rad) / tick’^*2  */ 

}, 

{  _ _ _ 
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/’^Upwards  turn.  *! 

0.999960667258,  I*  a_0  -  cos(rad)/tick  */ 
-3.1492328e-6  /*  a_l  -  cos(rad)/tick*’^  *! 

{ 

I*  Downwards  turn.  * ! 
0.999978909989,  a_0  -  cos(rad)/tick 

-7.8194991e-9  Z’"  a_l  -  cos(rad)/tick*’'2  *! 

} 


The  array  has  a  maximum  size  of  3  by  2  elements. 

Changing  this  constant  requires  a  recompile  because  of  the  hard  coded  multi¬ 
dimension  characteristic. 

3.40.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed.  The  size  of  the 
array  in  the  type  definition  for  MAX_COS_COEFF  determines  the  number  of 
elements  of  the  array  to  be  used  in  the  pol3momial  evaluation. 

3.40.2.1  Algorithm 

The  tow_burn_turn_coeff  array  is  initialized  and  scaled  for  ATGM  missile 
performance  by  a  call  to  the  CSU  missile_atgm_init. 


I*  change  turn  polynomial  coefficients  so  missile  has  larger  * !  ^ 

I*  max  turn  angle.  Since  Ph  deternaines  when  a  vehicle  should  be  *1 
!*  impacted,  turn  rates  should  not  effect  missile  effectiveness  */ 

|^^***,^w**********************■***************************************'  / 

for  (i=0;  i<tow_burn_turn_coeff.deg;  i++) 

tow_burn_turn_coeff.side_coeff[i]  *=  ATGM_TURN_FACTOR, 
tow_burn_turn_coeff.up_coeff[i]  *=  ATGM_TURN_FACTOR; 
tow_burn_turn_coeff.down_coeff[i]  *=  ATGM_TURN_F ACTOR, 

}  _ _ _ _ _ _ _ 
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for  (i=0;  i<tow_coast_turn_coeff.deg;  i++) 

{ 

tow_coast_turn_coeff.side_coeff[i]  ’^=  ATGM_TURN_F ACTOR; 
tow_coast_turn_coeff.up_coeff[i]  *=  ATGM_TURN_F ACTOR; 
tow_coast_turn_coeff.down_coeff[i]  *=  ATGM_TURN_FACTOR; 

} 


Tow_burn_turn_coeff  is  used  to  compute  the  cosine  of  the  maximum 
allowed  turn  angle  in  each  axis  for  the  ATGM  missile  during  powered  flight 
[burn]  using  the  CSU  missile_util_cos_coeff,  and  called  by  the  CSU 
missile_atgm_fly.  The  CSU  missile_util_cos_coeff  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  missile  pointer, 
coefficient  array,  and  time. 


/V 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 
*•  turn  angles  in  each  direction.  The  equations  used  are  different  before  and 
after  motor  burnout. 

/*/ 

if  (time  <  TOW_BURNOUT_TIME) 

{ 

mptr->speed  =  missile_util_evai_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)  +  mptr->init_speed; 
missile_util_eval_cos_coeff  (mptr,  &tow_burn_turn_coeff,  time); 

} 

else 

{ 

mptr->speed  =  missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)  +  mptr->init_speed; 
missile_util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time); 

} 


See  APPENDIX  F  for  a  complete  source  code  listing. 

3.41  Tow_coast  _tum_coeff  [for  ATGM] 

The  tow_coast_turn_coeff  two-dimensional  array  consists  of  the  coefficients 
for  three  polynomial  equations  [sidewards,  upwards,  and  downwards 
movement]  defining  the  ATGM  missile  maximum  cosine  of  turn  while 
unpowered  with  respect  to  time  in  the  form  using  the  Newton-Raphson 
method.  The  tow  missile  source  code  was  used  as  the  baseline  for  the  ATGM 
missile  function;  many  of  the  ATGM  constants,  variables,  CSCs  and  CSUs 
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have  the  same  name  as  in  the  TOW  missile  source  code.  A  turn  factor  is  used 
to  scale  the  TOW  coefficients  for  ATOM  performance. 

3.41.1  Initialization 

The  tow_coast_turn_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_atgm_init,  called  by  CSC  weaponsjnit.  Execution  of  the  CSU 
missile_atgm_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.41.  -  ATGM  Missile  Coast  Turn 
Coefficients  Data  Array  for  a  summary  of  the  array  data. 

The  array  has  a  maximum  size  of  3  by  4  elements. 

The  following  is  the  default  declaration. 


/V 

*  Coefficients  for  the  cosine  of  max  turn  polynomials  after  motor  burnout. 

/V 

t 

static  MAX_COS_COEFF  tow_coast_turn_coeff  = 

{ 

3,  /*  Order  of  the  polynomials. 

{ 

I*  Sidewards  turn.  '^1 
0.99995112518,  I*  a_0  -  cos(rad)/tick  *! 

8.96333e-7,  I*  a_l  -  cos(rad)/tick**2  *! 

-5.995375e-9,  I*  a_2  -  cos(rad)/tick*=^3 
1.162225e-ll  a_3  -  cos(rad)/tick’^’^4  V 

}, 

{ 

/*  Upwards  turn.  *! 

0.9998498495,  I*  a_0  -  cos(rad)/ tick  *! 

1.657779e-6,  I*  a_l  -  cos(rad)/tick=^=^2 
-8.231861e-9,  I*  a_2  -  cos(rad)/tick’^’^3  *! 

1.381832e-ll  I*  a_3  -  cos(rad)/tick*’^4  *! 

{ 

I*  Downwards  turn.  */ 

0.9999714014,  7=^  a_0  -  cos(rad)/tick  *! 

3.382077e-7,  I*  a_l  -  cos(rad)/tick’^’^2 
-1.601259e-9,  I*  a_2  -  cos(rad)/tick’^’^3  V 
2.623014e-12  a_3  -  cos(rad)/tick’^’^4  V 

} 

}; 
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3.41.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
MAVERICK_BURN_SPEED_DEG  determines  the  number  of  elements  of  the 
array  to  be  used  in  the  polynomial  evaluation. 


3.41.2.1  Algorithm 


The  tow_coast_turn_coeff  array  is  initialized  and  scaled  for  ATGM  missile 
performance  by  a  call  to  the  CSU  missile_atgm_init. 


t 


^^>^^*****************************************************************/ 
/*  change  turn  polynomial  coefficients  so  missile  has  larger  */ 

I*  max  turn  angle.  Since  Ph  determines  when  a  vehicle  should  be  V 

!*  impacted,  turn  rates  should  not  effect  missile  effectiveness  *! 

^I^i.^.ii,^**********^************************************'^*****************  I 

for  (i=0;  i<tow_burn_turn_coeff.deg;  i++) 


tow_burn_turn_coeff.side_coeff[i]  *=  ATGM_TURN_F ACTOR, 
tow_burn_turn_coeff.up_coeff[i]  *=  ATGM_TURN_F ACTOR; 
tow_burn_turn_coeff.down_coeff[i]  *=  ATGM_TURN_FACTOR, 

for  (i=0;  i<tow_coast_turn_coeff.deg;  i++) 


tow_coast_turn_coeff.side_coeff[i]  ’*'=  ATGM_TURN_F ACTOR; 
tow_coast_turn_coeff.up_coeff[i]  *=  ATGM_TURN_FACTOR; 
tow_coast_turn_coeff.down_coeff[i]  *=  ATGM_TURN_FACTOR, 
} 


Tow_coast_turn_coeff  is  used  to  compute  the  cosine  of  the  maximum 
allowed  turn  angle  in  each  axis  for  the  ATGM  missile  during  unpowered 
flight  [coast]  using  the  CSU  missile_util_cos_coeff,  and  called  by  the  CSU 
missile_atgm_fly.  The  CSU  missile_utiLcos_coeff  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  missile  pointer, 
coefficient  array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 

*  turn  angles  in  each  direction.  The  equations  used  are  different  before  and 

*  after  motor  burnout. 

/V 

if  (time  <  TOW_BURNOUT_TIME) 

{  _ _ _ _ _ 
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mptr->speed  =  missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 
tow_burn_speed_coeff,  time)  +  mptr->init_speed; 
missile_util_evaLcos_coeff  (mptr,  &tow_burn_turn_coeff,  time); 

} 

else 

mptr->speed  =  missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 
tow_coast_speed_coeff,  time)  +  mptr->init_speed; 
missile  util_eval_cos_coeff  (mptr,  &tow_coast_turn_coeff,  time), 

} 


See  APPENDIX  F  for  a  complete  source  code  listing. 

3.42  Kem_miss_char 

The  kem_miss_char  array  consists  of  characteristics  and  parameters 
describing  a  KEM  missile  system  and  its  performance  constraints.  The  KEM 
missile  source  code  was  derived  from  the  ADAT  missile  source  code. 

r 

3.42.1  KEM_BURNOUT_TIME 

KEM_BURNOUT_TIME  is  a  constant  defining  the  time  of  powered  flight  for 
kem  missile  in  ticks. 

3.42.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_kem_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_kem_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.42.  -  KEM  Missile  Characteristics  Data  Array  for  a 
summary  of  the  constants  data. 


#define  KEM_BURNOUT_TIME  kem_miss_char[0] 


3.42.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.42.2.1  Algorithm 

KEM_BURNOUT_TIME  is  used  to  control  computation  of  the  missile  flyout 
speed  by  a  call  to  the  CSC  missile_kem_fly. 
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/ 


Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 
turn  angles  in  each  direction.  The  equations  used  are  different  before 
and  after  motor  burnout. 

V 

if  (time  <  KEM_BURNOUT_TIME) 


{ 


mptr->speed  =  (missile_util_eval_poly  (KEM_BURN_SPEED  DEG, 
kem_burn_speed_coeff,  time)  KEM_TO_MACH5_FACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_BURN_TURN_DEG,  kem_burn_turn_coeff,  time); 


else 


mptr->speecl  =  (missile.uBLevaLpoly 

kem_coast_speed_coef£,  time)  *  KEM_TO_MACH5_FACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_COAST_TURN_DEG,  kem_coast_turn_coeff,  time); 


See  APPENDIX  H  for  a  complete  source  code  listing. 


3.42.2  KEM_MAX_FLIGHT_TIME 

KEM_MAX_FLIGHT_TIME  is  a  constant  defining  the  maximum  flight  time 
for  the  KEM  missile  in  ticks. 


3.42.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_kem_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_kem  init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performe 
sequentially.  See  TABLE  5.1.42.  -  KEM  Missile  Characteristics  Data  Array  for  a 
summary  of  the  constants  data. 

#define  KEM_MAX_FLIGHT_TIME  kem_miss_char[l] 


3.42.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.42.2.1  Algorithm 

KEM_MAX_FLIGHT_TIME  is  used  to  initialize  the  maximum  flight  time  for 
an  individual  KEM  missile  by  a  call  to  the  CSU  missile_kem_init. 


for  (i  =  0;  i  <  num_missiles;  i++) 

{ 

kem_array[i].mptr.state  =  KEM_FREE; 
kem_array[i].mptr.max_flight_time  =  KEM_MAX_FLIGUT_TIME; 
kem_array[i].mptr.max_turn_directions  =  1; 

} 


See  APPENDIX  H  for  a  complete  source  code  listing. 

3.42.3  KEM_TO_MACH5_FACTOR 

KpM_TO_MACH5_F ACTOR  is  a  constant  defining  the  speed  factor  to  raise 
missile  performance  from  AD  AT  to  KEM;  just  after  burnout,  the  ADAT  has  a 
maximum  velocity  of  230  m/ sec,  while  the  KEM  has  a  maximum  velocity  of 
1524  m/sec. 

3.42.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_kem_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_kem_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.42.  -  KEM  Missile  Characteristics  Data  Array  for  a 
summary  of  the  constants  data. 


#define  KEM_TO_MACFI5_F ACTOR  kem_miss_char[2] 


3.42.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.42.2.1  Algorithm 

KEM_TO_MACH5_FACTOR  is  used  to  scale  the  burn  speed  coefficients 
when  the  launch  speed  is  computed  by  a  call  to  the  CSU  missile_kem_fire. 
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I* 

*  Set  the  initial  time,  location,  orientation,  and  speed  of  the  generic 
missile. 

V 

mptr->time  =  0.0; 

vec_copy  (launch_point,  mptr->location); 
mat_copy  (loc_sight_to_world,  mptr->orientation); 

mptr->speed  =  (missile_util_eval_poly  (KEM_BURN_SPEED_DEG, 
kem_burn_speed_coeff,-0.0)  KEM_TO_MACH5_F ACTOR)  + 
launch_speed; 

mptr->init_speed  =  launch_speed; 

if  (kptr->target_vehicie_id.vehicle  ==  vehicleirrelevant) 
comm_target_type  =  targetUnknown; 
else 

comm_target_type  =  targetlsVehicle; 


% 

KEM_TO_MACH5_F ACTOR  is  used  to  scale  the  burn  speed  and  coast  speed 
coefficients  when  the  missile  flyout  speed  is  computed  by  a  call  to  the  CSU 
missile_kem_fly. 


I* 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 

*  turn  angles  in  each  direction.  The  equations  used  are  different  before 

*  and  after  motor  burnout. 

V 

if  (time  <  KEM_BURNOUT_TIME) 

{ 

mptr->speed  =  (missile_util_eval_poly  (KEM_BURN_SPEED_DEG, 
kem_burn_speed_coeff,  time)  *  KEM_TO_MACH5_FACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_BURN_TURN_DEG,  kem_burn_turn_coeff,  time); 

}  _ _ _ 


-299- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


else 

mptr->speed  =  (missile_util_eval_poly  (KEM_COAST_SPEED_DEG, 
kem_coast_speed_coeff,  time)  *  KEM_TO_MACH5_F ACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_COAST_TURN_DEG,kem_coast_turn_coeff,  time); 

} 


See  APPENDIX  H  for  a  complete  source  code  listing. 

3.43  Kem_miss_poly_deg 

The  kem_miss_poly_deg  array  consists  of  values  of  the  degree  of  each 
polynomial  equation  used  to  compute  the  burn  speed,  the  coast  speed, 
maximum  cosines  of  turns  while  powered,  and  maximum  cosines  of  turns 
while  unpowered  for  the  KEM  missile.  The  KEM  missile  source  code  was 
derived  from  the  ADAT  missile  source  code. 

$ 

3.43.1  KEM_BURN_SPEED_DEG 

KEM_BURN_SPEED_DEG  is  a  constant  defining  the  polynomial  degree  for 
the  KEM  missile  burn  speed  coefficient  data  array. 
KEM_BURN_SPEED_DEG  is  the  first  element  of  the  kem_miss_poly_deg 
array. 

3.43.1.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_kem_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_kem_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.43.  -  KEM  Missile  Polynomial  Degree  Data  Array 
for  a  summary  of  the  constants  data. 


#define  KEM_BURN_SPEED_DEG  kem_miss_poly_deg[0] 


3.43.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  KEM_BURN_SPEED_DEG  is  9,  especially,  the  declared  size  of  the 
kem_burn_speed_coeff  array  is  10. 
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3.43.1.2.1  Algorithm 

KEM_BURN_SPEED_DEG  is  used  to  compute  the  KEM  missile  speed  at 
launch  using  Ihe  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missile_kem_fire.  The  CSU  inissile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


Set  the  initial  time,  location,  orientation,  and  speed  of  the  generic 
missile. 

V 

mptr->time  =  0.0; 

vec_copy  (launch_point,  mptr->location); 

mat  copy  (loc_sight_to_world,  mptr">orientation), 

mptr->speed  =  (missile_util_eval_poly  (KEM_BURN_SPEED_DEG, 
(  kem_burn_speed_coeff,  0.0)  *  KEM_TO_MACH5_F ACTOR)  + 

launch_speed; 

mptr->init_speed  =  launch_speed; 

if  (kptr->  tar get_vehicle_id. vehicle  ==  vehicleirrelevant) 
comm_target_type  =  targetUnknown; 
else 

comm_target_type  =  targetlsVehicle; 


KEM_BURN_SPEED_DEG  is  used  to  compute  the  KEM  naissile  speed  during 
powered  flight  [burn]  using  the  CSU  missile_util_eval_poly,  and  called  by 
the  CSU  missile_kem_fly.  The  CSU  missile_util_evaLpoly  uses  the 
Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree 
of  polynomial,  coefficient  array,  and  time. 


I* 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 

*  turn  angles  in  each  direction.  The  equations  used  are  different  before 
and  after  motor  burnout. 

V 

if  (time  <  KEM_BURNOUT_TIME) 

mptr->speed  =  (missile_util_eval_poly  (KEM_BURN_SPEED_DEG, 
kem_burn_speed_coeff,  time)  *  KEM_TO_MACH5_F ACTOR)  + 
mptr->init_speed; _ _ ^ _ 
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mptr->cos_max_turnLOJ  =  missile_util_eval_poly  ( 

KEM_BURN_TURN_DEG,  kem_burn_turn_coeff,  time); 

} 

else 

mptr->speed  =  (missile_util_eval_poly  (KEM_COAST_SPEED_DEG, 
kem_coast_speed_coeff,  time)  *  KEM_TO_MACH5_F ACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_COAST_TURN_DEG,  kem_coast_turn_coeff,  time); 

} 


See  APPENDIX  H  for  a  complete  source  code  listing. 

3.43.2  KEM_COAST_SPEED_DEG 

KEM_COAST_SPEED_DEG  is  a  constant  defining  the  polynomial  degree  for 
the  kern  missile  coast  speed  coefficient  data  array. 
KEM_COAST_SPEED_DEG  is  the  second  element  of  the 
kem_miss_poly_deg  array. 

3.43.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_kem_init, 
called  by  CSC  weapons.init.  Execution  of  the  CSU  missile.kem  init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.43.  -  KEM  Missile  Polynomial  Degree  Data  Array 
for  a  summary  of  the  constants  data. 


#define  KEM_COAST_SPEED_DEG  kem_miss_poly_deg[l] 


3.43.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maxirnum 
value  for  KEM_COAST_SPEED_DEG  is  9,  especially,  the  declared  size  of  the 
kem_burn_speed_coeff  array  is  10. 

3.43.2.2.1  Algorithm 

KEM  COAST_SPEED_DEG  is  used  to  compute  the  KEM  missile  speed 
during  unpowered  flight  [coast]  using  the  CSU  missile_util_eval_poly,  and 
called  by  the  CSU  missile_kem_fly.  The  CSU  missile_util_eval_poly  uses 
the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 
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*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 

*  turn  angles  in  each  direction.  The  equations  used  are  different  before 

and  after  motor  burnout. 

V 

if  (time  <  KEM_BURNOUT_TIME) 

mptr->speed  =  (missile_util_eval_poly  (KEM_BURN_SPEED_DEG, 
]<em_burn_speed_coeff,  time)  KEM_TO_MACH5_F ACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_BURN_TURN_DEG,  kem_burn_turn_coeff,  time); 

} 

else 

mptr->speed  =  (missile_util_eval_poly  (KEM_COAST_SPEED_DEG, 
kem_coast_speed_coeff,  time)  *  KEM_TO_MACH5_F ACTOR)  + 

'  mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_COAST_TURN_DEG,  kem_coast_turn_coeff,  time); 

} 


See  APPENDIX  H  for  a  complete  source  code  listing. 

3.43.3  KEM_BURN_TURN_DEG 

KEM_BURN_TURN_DEG  is  a  constant  defining  the  polynomial  degree  for 
the  cosine  of  the  KEM  missile  maximum  allowed  turn  angle,  burn  turn 
coefficient  data  array.  KEM_BURN_TURN_DEG  is  the  third  element  of  the 
kem_miss_poly_deg  array. 

3.43.3.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_kern_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_kem_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.43.  -  KEM  Missile  Polynomial  Degree  Data  Array 
for  a  summary  of  the  constants  data. 


#define  KEM_BURN_TURN_DEG  kem_miss_poly_deg[2] 
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3.43.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maxirnum 
value  for  KEM_BURN_TURN_DEG  is  9,  especially,  the  declared  size  of  the 
kem_burn_speed_coeff  array  is  10. 

3.43.3.2.1  Algorithm 

KEM_BURN_TURN_DEG  is  used  to  compute  the  cosine  of  the  maximum 
allowed  turn  angle  for  the  KEM  missile  during  powered  flight  [burn]  using 
the  CSU  missile_util_eval_poly,  and  called  by  the  CSU  missile_kem_fly. 
The  CSU  missile_util_eval_poly  uses  the  Newton-Raphson  method  to 
evaluate  the  polynomial  with  inputs  of  degree  of  polynomial,  coefficient 
array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 

*  turn  angles  in  each  direction.  The  equations  used  are  different  before 

and  after  motor  burnout. 

V 

if  (time  <  KEM_BURNOUT_TIME) 

mptr->speed  =  (missile_util_eval_poly  (KEM_BURN_SPEED_DEG, 
kem_burn_speed_coeff,  time)  *  KEM_TO_MACH5_FACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_BURN_TURN_DEG,  kem_burn_turn_coeff,  time); 

} 

else 

mptr->speed  =  (missile_util_eval_poly  (KEM_COAST_SPEED_DEG, 
kem_coast_speed_coeff,  time)  *  KEM_TO_MACH5_F ACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_COAST_TURN_DEG,  kem_coast_turn_coeff,  time); 

} 


See  APPENDIX  H  for  a  complete  source  code  listing. 

3.43.4  KEM_COAST_TURN_DEG 

KEM_COAST_TURN_DEG  is  a  constant  defining  the  polynomial  degree  for 
the  cosine  of  the  KEM  missile  maximum  allowed  turn  angle,  coast  turn 
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coefficient  data  array.  KEM_COAST_TURN_DEG  is  the  fourth  element  of 
the  kem_miss_poly_deg  array. 

3.43.4.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_kem_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_kem_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.43.  -  KEM  Missile  Polynomial  Degree  Data  Array 
for  a  summary  of  the  constants  data. 


#define  KEM_COAST_TURN_DEG  kem_miss_poly_deg[3] 


3.43.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  KEM_COAST_TURN_DEG  is  9,  especially,  the  declared  size  of  the 
kcm_b^rn_speed_coeff  array  is  10. 

3.43.4.2.1  Algorithm 

KEM_COAST_TURN_DEG  is  used  to  compute  the  cosine  of  the  maximum 
allowed  turn  angle  for  the  KEM  missile  during  unpowered  flight  [coast]  using 
the  CSU  missile_util_eval_poly,  and  called  by  the  CSU  missile_kem_fly. 
The  CSU  missile_util_eval_poly  uses  the  Newton-Raphson  method  to 
evaluate  the  polynomial  with  inputs  of  degree  of  polynomial,  coefficient 
array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 
turn  angles  in  each  direction.  The  equations  used  are  different  before 

*  and  after  motor  burnout. 

V 

if  (time  <  KEM_BURNOUT_TIME) 

mptr->speed  =  (missile_util_eval_poly  (KEM_BURN_SPEED_DEG, 
kem_burn_speed_coeff,  time)  *  KEM_TO_MACH5_F ACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_BURN_TURN_DEG,  kem_burn_turn_coeff,  time); 

} 

else 

{  _ _ _ 
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mptr->speed  =  (missile_util_eval_poly  (KEM_COAST_SPEED_DEG, 
kem_coast_speed_coeff,  time)  *  KEM_TO_MACH5_F ACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_COAST_TURN_DEG,  kem_coast_turn_coeff,  time); 

} 


See  APPENDIX  H  for  a  complete  source  code  listing. 

3.44  Kem_burn_speed_coeff 

The  kem_burn_speed_coeff  array  consists  of  the  coefficients  for  a  polynomial 
equation  defining  the  KEM  missile  burn  speed  with  respect  to  time  in  the 
form  using  the  Newton-Raphson  method.  The  KEM  missile  source  code  was 
derived  from  the  ADAT  missile  source  code. 

3.44.1  Initialization 

The  kem_burn_speed_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_kem_init,  called  by  CSC  weaponsjnit.  Execution  of  the  CSU 
missile_kem_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.44.  -  KEM  Missile  Burn  Speed 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 

The  following  is  the  default  declaration. 


*  Coefficients  for  the  speed  polynomial  before  motor  burnout  initialized 
to  default  values. 

/V 
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static  REAL  kem_burn_speed_coeffL10J  = 

1 

2.296, 

/*  a  0-  m/tick  */ 

0.72990856, 

/*aj-  m/tick=^*2  V 

0.013310932, 

/*  a_2  -  m/tick**3  */ 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0 

}; 

The  array  has  a  maximum  size  of  10  elements. 


3.44.2  Usage 

t)uring  real-time  execution,  this  array  is  not  recoinputed. 
KEM_BURN_SPEED_DEG  determines  the  number  of  elements  of  the  array 
to  be  used  in  the  polynomial  evaluation. 

3.44.2.1  Algorithm 

The  kem  burn_speed_coeff  array  is  used  to  compute  the  initial  speed  at 
launch  of  the  KEM  missile  using  the  CSU  missile_util_eval_poly,  and  called 
by  the  CSU  missile_kem_fire.  The  CSU  missile_util_evaLpoly  uses  the 
Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree 
of  polynomial,  coefficient  array,  and  time. 


mptr->speed  =  (missile_util_eval_poly  (KEM_BURN_SPEED_DEG, 
kem_burn_speed_coeff,  0.0)  *  KEM_TO_MACH5_F ACTOR)  + 
launch_speed; 


The  kem_burn_speed_coeff  array  is  used  to  compute  the  KEM  missile  speed 
during  powered  flight  [burn]  using  the  CSU  missile_utiLeval_poly,  and 
called  by  the  CSU  missile_kem_fly.  The  CSU  missile_utiLevaLpoly  uses 
the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 
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I* 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 

*  turn  angles  in  each  direction.  The  equations  used  are  different  before 

*  and  after  motor  burnout. 

V 

if  (time  <  KEM_BURNOUT_TIME) 

mptr->speed  =  (missile_util_eval_poly  (KEM_BURN_SPEED_DEG, 
kem_burn_speed_coeff,  time)  *  KEM_TO_MACH5_F ACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_BURN_TURN_DEG,  kem_burn_turn_coeff,  time); 

} 

else 

mptr->speed  =  (missile_util_eval_poly  {KEM_COAST_SPEED_DEG, 
kem_coast_speed_coeff,  time)  *  KEM_TO_MACH5_F ACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_COAST_TURN_DEG,  kem_coast_turn_coeff,  time); 

} 


See  APPENDIX  H  for  a  complete  source  code  listing. 

3.45  Kem_coast_speed_coe£f 

The  kem_coast_speed_coeff  array  consists  of  the  coefficients  for  a  polynomial 
equation  defining  the  KEM  missile  coast  speed  with  respect  to  time  in  the 
form  using  the  Newton-Raphson  method.  The  KEM  missile  source  code  was 
derived  from  the  ADAT  missile  source  code. 

3.45.1  Initialization 

The  kem_coast_speed_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_kem_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_kem_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.45.  -  KEM  Missile  Coast  Speed 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 

The  following  is  the  default  declaration. 
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/*/ 

Coefficients  for  the  speed  polynomial  after  motor  burnout. 

/V 

static  REAL  kem_coast_speed_coeff[10]  = 

f 

t 

105.52162, 

/*  a_0  -  m/tick  */ 

-1.0157285, 

/*  a_l  -  m/tick’^*2  */ 

5.6124330e-3, 

/*  a_2  -  m/tick*'’^3  */ 

-1.6262608e-5, 

/*  a_3  -  m/tick*M  */ 

1.8991982e-8, 

/*  a_4  -  m/tick*’^5  */ 

0.0, 

0.0, 

0.0, 

0.0, 

0.0 

}; 

The  array  has  a  maximum  size  of  10  elements. 


3.45.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
KEM_COAST_SPEED_DEG  determines  the  number  of  elements  of  the  array 
to  be  used  in  the  polynomial  evaluation. 

3.45.2.1  Algorithm 

The  kem_coast_speed_coeff  array  is  used  to  compute  the  KEM  missile  speed 
during  unpowered  flight  [coast]  using  the  CSU  missile_util_eval_poly,  and 
called  by  the  CSU  missile_kem_fly.  The  CSU  missile_util_eval_poly  uses 
the  Newton-Raphson  method  to  evaluate  the  polynomial  with  inputs  of 
degree  of  polynomial,  coefficient  array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 

*  turn  angles  in  each  direction.  The  equations  used  are  different  before 

*  and  after  motor  burnout. 

V 

if  (time  <  KEM_BURNOUT_TIME) 

{ 

mptr->speed  =  (missile_util_eval_poly  (KEM_BURN_SPEED_DEG, 
kem_burn_speed_coeff,  time)  KEM_TO_MACH5_F ACTOR)  + 
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mptr->init_speed; 

inptr->cos_inax_turn[0]  =  missile_util_eval_poly  ( 

KEM_BURN_TURN_DEG,  kem_burn_turn_coeff,  time); 

} 

else 

mptr->speed  =  (missile_util_eval_poly  (KEM_COAST_SPEED_DEG, 
kem_coast_speed_coeff,  time)  *  KEM_TO_MACH5_F ACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_COAST_TURN_DEG,  kem_coast_turn_coeff,  time); 

} 


See  APPENDIX  H  for  a  complete  source  code  listing. 

3.46  Kem_burn_turn_coeff  ’ 

The  kem_burn_turn_coeff  array  consists  of  the  coefficients  for  a  polynomial 
equation  defining  the  KEM  missile  maximum  cosine  of  the  turn  angle  while 
in  powered  flight  with  respect  to  time  in  the  form  using  the  Newton- 
Raphson  method.  The  KEM  missile  source  code  was  derived  from  the  AD  AT 
missile  source  code. 

3.46.1  Initialization 

The  kem_burn_turn_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_kem_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_kem_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.46.  -  KEM  Missile  Burn  Turn 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 


The  following  is  the  default  declaration. 


Coefficients  for  the  cosine  of  max  turn  polynomial  before  motor  burnout. 

/V 


static  REAL  kem_burn_turn_coeff[10]  = 


{ 

0.999993, 

-6.2386917e-7, 

1.6146426e-7, 

-9.720142e-7, 


/*  a_0  -  cos(rad)/tick  */ 

/*  a_l  -  cos(rad)/tick*’^2  */ 
/*  a_2  -  cos(rad)/tick’^’^3  *! 
I*  a_3  -  cos(rad)/ tick’^M  */ 
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The  array  has  a  maximum  size  of  10  elements. 


3.46.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
KEM_BURN_TURN_DEG  determines  the  number  of  elements  of  the  array 
to  be  used  in  the  polynomial  evaluation. 

3.46.2.1  Algorithm 

The  kem_burn_turn_coeff  array  is  used  to  compute  the  cosine  of  the 
maximum  allowed  turn  angle  for  the  KEM  missile  during  powered  flight 
[burn]  using  the  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missile_kemjly.  The  CSU  missile_utiLeval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 

*  turn  angles  in  each  direction.  The  equations  used  are  different  before 

*  and  after  motor  burnout. 

V 

if  (time  <  KEM_BURNOUT_TIME) 

{ 

mptr->speed  =  (missile_util_eval_poly  (KEM_BURN_SPEED_DEG, 
kem_burn_speed_coeff,  time)  *  KEM_TO_MACH5_FACTOR)  + 
mp  tr->ini  t_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_BURN_TURN_DEG,  kem_burn_turn_coeff,  time); 

}  _ _ _ _ _ 
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else 

mptr->speed  =  (missile_util_eval_poly  (KEM_COAST_SPEED_DEG, 
kem_coast_speed_coeff,  time)  *  KEM_TO_MACH5_F ACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_COAST_TURN_DEG,  kem_coast_turn_coeff,  time); 

} 


See  APPENDIX  H  for  a  complete  source  code  listing. 

3.47  Kem_coast_turn_coeff 

The  kem_coast_turn_coeff  array  consists  of  the  coefficients  for  a  polynomial 
equation  defining  the  KEM  missile  maximum  cosine  of  the  turn  angle  while 
in  unpowered  flight  with  respect  to  time  in  the  form  using  the  Newton- 
Raphson  method.  The  KEM  missile  source  code  was  derived  from  the  ADAT 
missile  source  code. 

f 

3.47.1  Initialization 

The  kem_coast_turn_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_kem_init,  called  by  CSC  weapons_init.  Execution  of  the 
missile_kem_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.47.  -  KEM  Missile  Coast  Turn 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 


The  following  is  the  default  declaration. 


/V 

*  Coefficients  for  the  cosine  of  max  turn  polynomial  after  motor  burnout. 

/V 

static  REAL  kem_coast_turn_coeff[10]  = 

{ 

0.99753111, 

5.5817986e-5, 

-5.1276276e-7, 

2.2388593e-9, 

-5.1964622e-12, 

4.5499104e-15, 


/*  a_0-  cos(rad)/tick  */ 

/*  a_l  -  cos(rad)/tick*’^2  */ 
/*  a_2  -  cos(rad)/tick’^*3  */ 
/*  a_3  -  cos(rad)/ tick^M  */ 
/*  a_4  -  cos  (rad)/  tick*’^5  */ 
/*  a_5  -  cos  (rad)/  tick*’^6  */ 
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0.0, 

0.0, 

0.0, 

0.0 

}; 


The  array  has  a  maximum  size  of  10  elements. 


3.47.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
MAVERICK_BURN_SPEED_DEG  determines  the  number  of  elements  of  the 
array  to  be  used  in  the  polynomial  evaluation. 

3.47.2.1  Algorithm 

The  kem_coast_turn_coeff  array  is  used  to  compute  the  cosine  of  the 
maximum  allowed  turn  angle  for  the  KEM  missile  during  unpowered  flight 
[coast]  using  the  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missile_kem_fly.  The  CSU  missile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  time. 


*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed 

*  turn  angles  in  each  direction.  The  equations  used  are  different  before 

*  and  after  motor  burnout. 

V 

if  (time  <  KEM_BURNOUT_TIME) 

mptr->speed  =  (missile_util_eval_poly  (KEM_BURN_SPEED_DEG, 
kem_burn_speed_coeff,  time)  *  KEM_TO_MACH5_F ACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_BURN_TURN_DEG,  kem_burn_turn_coeff,  time); 

} 

else 

mptr->speed  =  (missile_util_eval_poly  (KEM_COAST_SPEED_DEG, 
kem_coast_speed_coeff,  time)  *  KEM_TO_MACH5_F ACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( 

KEM_COAST_TURN_DEG,  kem_coast_turn_coeff,  time); 

}  _ _ _ 
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See  APPENDIX  H  for  a  complete  source  code  listing. 

3.48  Nlos_miss_char 

The  nlos_miss_char  array  consists  of  characteristics  and  parameters 
describing  an  NLOS  missile  system  and  its  performance  constraints. 

3.48.1  NLOS_LOCK_THRESHOLD 

NLOS_LOCK_THRESHOLD  is  a  constant  defining  the  threshold  lock  for  the 
NLOS  missile 

3.48.1.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  NLOS_LOCK_THRESHOLD  nlos_miss_char[  0] 


3.48.1.2  Usage 

During  real-time  execution,  this  constant,  is  not  recomputed. 

3.48.1.2.1  Algorithm 

NLOS_LOCK_THRESHOLD  is  used  to  compute  the  vector  to  the  preferred 
vehicle  by  a  call  to  the  CSU  near_get_preferred_veh_near_vector  in  a  call  to 
the  CSC  missile_nlos_fly. 


/V  .  ;  . 

*  choose  the  correct  targeting  option  depending  on  flight  time 

/V 

if  (time  ==  NLOS_LEVEL_FLIGHT_TIME) 
printf("extra_waypoint:  %i  %f  %f\n", 
mptr->location[0], 
mptr->location[l], 
mp  tr->loca  tion  [2] ); 

if  (time  <  NLOS_VERTICAL_FLIGHT_TIME) _ 
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missile_nlos_fly_to_point(inptr,  peak_target); 
else  if  (time  <  NLOS_DECLINE_FLIGHT_TIME) 

missile_nlos_fly_to_point(mptr,  decline_target); 
else  if  (time  <  NLOS_LEVEL_FLIGHT_TIME) 

{ 

level_target[Z]  =  mptr->location[Z]; 
missile_nlosJly_to_point(mptr,  level_target); 

} 

else 

{ 

switch  (target_scheme)  ■ 

{ 

case  NLOS_FLY_TO_POINT_IN_SPACE: 

missile_nlos_fly_to_point(mptr,  nlos_target_loc); 
break; 

case  NLOS_FLY_TO_POINT_RELATIVE: 

missile_target_nlos(mptr,  nlos_target_loc); 
break; 

case  NLOS_FLY_TO_TARGET: 

target  =  near_get_preferred_veh_near_vector  ( 
&:nlos_target_id, 
RVA_ALL_VEH, 
mptr->location, 
mp  tr->orienta  tion  [1  ] , 
NLOS_LOCK_THRESHOLD, 
&nlos_req_id); 

if  (target  !=  NULL) 

{ 

timed_printf("miss_nlos:  target  locked  on\n"); 
missile_target_pursuit  (mptr,  target); 

} 

else 

{ 

inissile_target_unguided(mptr); 

} 

break; 

default: 

printf("missile_nlos_fly:  bad  target_scheme\n"); 
break; 

} 

} 
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See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.2  NLOS_MAX_TURN_ANGLE 

NLOS_MAX_TURN_ANGLE  is  a  constant  defining  the  maximum  turn 
angle  for  the  NLOS  missile. 

3.48.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  NLOS_MAX_TURN_ANGLE  nlos_miss_char[  1] 


348.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.2.2.1  Algorithm 

NLOS_MAX_TURN_ANGLE  is  used  to  compute  the  cosine  of  the 
maximum  turn  angle  for  the  NLOS  missile  by  a  call  to  the  CSU 
missile_nlos_init. 

mptr->cos_max_turn[0]  =  cos  (NLOS_MAX_TURN_ANGLE); 


See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.3  NLOS_VERTICAL_FLIGHT_TIME 

NLOS_VERTICAL_FLIGHT_TIME  is  a  constant  defining  the  flight  time  in 
the  vertical  mode  for  the  NLOS  missile. 

3.48.3.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 
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#define  NLOS_VERTICAL_FLIGHT_TIME  nlos_miss_char[  2] 

3.48.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.3.2.1  Algorithm 

NLOS_VERTICAL_FLIGHT_TIME  is  used  control  the  flight  path  of  the 
NLOS  missile  by  a  call  to  the  CSC  missile_nlos_fly. 


/V 

choose  the  correct  targeting  option  depending  on  flight  time 

/V 

if  (time  ==  NLOS_LEVEL_FLIGHT_TIME) 

I  printf("extra_waypoint:  %f  %f  %f\n", 
mptr->location[0], 
mptr->location[l], 
mptr->loca  tion  [2] ); 

if  (time  <  NLOS_VERTICAL_FLIGHT_TIME) 
missile_nlos_fly_to_point(mptr,  peak_target); 
else  if  (time  <  NLOS_DECLINE_FLIGHT_TIME) 

missile_nlos_fly_to_point(mptr,  decline_target); 
else  if  (time  <  NLOS_LEVEL_FLIGHT_TIME) 

{ 

level_target[Z]  =  mptr->iocation[Z]; 
missile_nlos_fly_to_point(mptr,  level_target); 

} 

else 

{ 

switch  (target_scheme) 

{ 

case  NLOS_FLY_TO_POINT_IN_SPACE: 

missile_nlos_fly_to_point(mptr,  nlos_target_loc); 
break; 

case  NLOS_FLY_TO_POINT_RELATIVE; 

missile_target_nlos(mptr,  nlos_target_loc); 
break; 
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case  NLOS_FLY_TO_TARGET: 

target  =  near_get_preferred_veh_near_vector  ( 

&nlos_target_id, 

RVA_ALL_VEH, 
mptr->location, 
mp  tr->orien  ta  tion  [  1  ] , 
NLOS_LOCK_THRESHOLD, 

&nlos_req_id); 

if  (target  !=  NULL) 

{ 

timed_printf("miss_nlos:  target  locked  on\n"); 
missile_target_pursuit  (mptr,  target); 

} 

else 

{ 

missile_target_unguided(mptr); 

} 

break; 

default; 

printf("missile_nlos_fly:  bad  target_scheme\n"); 

break; 

} 

} 


See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.4  NLOS_DECLINE_FLIGHT_TIME 

NLOS_DECLINE_FLIGHT_TIME  is  a  constant  defining  the  flight  time  in  the 
decline  mode  for  the  NLOS  missile. 

3.48.4.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  NLOS_DECLINE_FLIGHT_TIME  nlos_miss_char[  3] 
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3.48.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.4.2.1  Algorithm 

NLOS_DECLINE_FLIGHT_TIME  is  used  control  the  flight  path  of  the  NLOS 
missile  by  a  call  to  the  CSC  missile_nlos_fly. 


*  choose  the  correct  targeting  option  depending  on  flight  time 

/V 

if  (time  ==  NLOS_LEVEL_FLIGHT_TIME) 
printf("extra_waypoint:  %f  %f  %f\n", 
mptr->location[0], 
mptr->location[l], 
mptr->location[2]); 

if  (time  <  NLOS_VERTICAL_FLIGHT_TIME) 

missile_nlosJly_to_point(mptr,  peak_target); 
else  if  (time  <  NLOS_DECLINE_FLIGHT_TIME) 

missile_nlos_fly_to_point(mptr,  decline_target); 
else  if  (time  <  NLOS_LEVEL_FLIGHT_TIME) 

{ 

level_target[Z]  =  mptr->location[Z]; 
missile_nlos_fly_to_point(mptr,  level_target); 

} 

else 

{ 

switch  (target_scheme) 

{ 

case  NLOS_FLY_TO_POINT_IN_SPACE: 

missile_nlos_fly_to_point(mptr,  nlos_target_loc); 
break; 

case  NLOS_FLY_TO_POINT_RELATIVE: 

missile_target_nlos(mptr,  nlos_target_loc); 
break; 


-319- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 

case  NLOS_FLY_TO_TARGET; 

target  =  near_get_preferred_veh_near_vector  ( 

&nlos_target_id, 

RVA_ALL_VEH, 
inptr->location, 
mp  tr->orien  ta  tion  [  1  ] , 
NLOS_LOCK_THRESHOLD, 

&nlos_req_id); 

if  (target  !=  NULL) 

{ 

timed_printf("miss_nlos:  target  locked  on\n"); 
missile_target_pursuit  (mptr,  target); 

} 

else 

{ 

missile_target_unguided(mptr); 

} 

break; 

default: 

printf("missile_nlos_fly:  bad  target_scheme\n"); 

break; 

1 

} 


See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.5  NLOS_LEVEL_FLIGHT_TIME 

NLOS_LEVEL_FLIGHT_TIME  is  a  constant  defining  the  flight  time  in  the 
level  mode  for  the  NLOS  missile. 

3.48.5.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_nlos_mR  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  NLOS_LEVEL_FLIGHT_TIME  nlos_miss_char[  4] 
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3.48.5.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.5.2.1  Algorithm 

NLOS_LEVEL_FLIGHT_TIME  is  used  control  the  flight  path  of  the  NLOS 
missile  by  a  call  to  the  CSC  missile_nlos_fly. 


/V 

*  choose  the  correct  targeting  option  depending  on  flight  time 

/V 

if  (time  ==  NLOS_LEVEL_FLICHT_TIME) 
printf("extra_waypoint:  %f  %f  %f\n", 
mptr->location[0], 
mptr->location[l], 
mptr->loca  tion  [2] ); 

'  if  (time  <  NLOS_VERTICAL_FLICHT_TIME) 

missile_nlos_fly_to_point(mptr,  peak_target); 
else  if  (time  <  NLOS_DECLINE_FLICHT_TIME) 
missile_nlos_fly_to_point(mptr,  decline_target); 
else  if  (time  <  NLOS_LEVEL_FLICHT_TIME) 

{ 

level_target[Z]  =  mptr->location[Z]; 
missile_nlos_fly_to_point(mptr,  level_target); 

} 

else 

{ 

switch  (target_scheme) 

{ 

case  NLOS_FLY_TO_POINT_IN_SPACE: 

missile_nlos_fly_to_point(mptr,  nlos_target_loc); 
break; 

case  NLOS_FLY_TO_POINT_RELATIVE: 
missile_target_nlos(mptr,  nlos_target_loc); 
break; 
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case  NLOS_FLY_TO_TARGET: 

target  =  near_get_preferred_veh_near_vector  ( 

&nlos_target_id, 

RVA_ALL_VEH, 

mptr->location, 

mp  tr->or  ien  ta  tion  [  1  ] , 

NLOS_LOCK_THRESHOLD, 

&nlos_req_id); 

if  (target  !=  NULL) 

tiined_printf("miss_nlos;  target  locked  on\n"); 
missile_target_pursuit  (mptr,  target); 

} 

else 

{ 

missile_target_unguided(mptr); 

} 

break; 

default; 

printf("missile_nlos_fly;  bad  target_scheme\n"); 
break; 

} 

} 


See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.6  NLOS_ARM_TIME 

NLOS_ARM_TIME  is  a  constant  defining  the  nlos  missile  arm  time  delay 
before  firing  in  ticks. 

3.48.6.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_nlos_mit  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  NLOS_ARM_TIME  nlos_miss_char[  5] 
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3.48.6.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.6.2.1  Algorithm 

NLOS_ARM_TIME  is  not  used  in  the  current  calculations. 

See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.7  NLOS_BURNOUT_TIME 

NLOS_BURNOUT_TIME  is  a  constant  defining  the  time  of  powered  flight 
for  the  nlos  missile  in  ticks. 

3.48.7.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  NLOS_BURNOUT_TIME  nlos_miss_char[  6] 


3.48.7.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.7.2.1  Algorithm 

NLOS_BURNOUT_TIME  is  not  used  in  the  current  calculations. 

See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.8  NLOS_MAX_FLIGHT_TIME 

NLOS_MAX_FLIGHT_TIME  is  a  constant  defining  the  maximum  flight  time 
for  the  nlos  missile  assumed  in  ticks.  . 

3.48.8.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
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sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  NLOS_MAX_FLIGHT_TIME  nlos_miss_char[  7] 


3.48.8.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.8.2.1  Algorithm 

NLOS_MAX_FLIGHT_TIME  is  used  to  initialize  the  maximum  flight  time 
for  the  NLOS  missile  in  the  CSU  missile_nlos_init. 

mptr->max_flight_time  =  NLOS_MAX_FLIGHT_TIME; 

I 

See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.9  SPEED_0 

SPEED_0  is  a  constant  defining  the  reference  speed  for  the  NLOS  missile. 

3.48.9.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 

#define  SPEED_0  nlos_miss_char[  8] 

3.48.9.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.9.2.1  Algorithm 

SPEED_0  is  used  to  initialize  the  speed  for  the  NLOS  missile  in  calls  to  the 
CSU  missile_nlos_init  and  the  CSU  missile_nlos_fire. 
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See  APPENDIX  J  for  a  complete  source  code  listing. 


3.48.10  SPEED_1 

SPEED_1  is  a  constant  defining  the  second  speed  profile  of  the  NLOS  missile 
during  flight. 

3.48.10.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


I 

#define  SPEED_1  nlos_miss_char[  9] 


3.48.10.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.10.2.1  Algorithm 

SPEED_1  is  used  to  initialize  the  NLOS  flight  speed  during  the  second  phase 
of  the  flyout  after  time  from  launch  exceeds  800  ticks. 


/V 

*  Set  and  _time_.  This  is  created  mostly  for  increased  readablity. 

/V 

time  =  mptr->time; 

if  (time  >  800.0) 

mptr->speed  =  SPEED_1; 


See  APPENDIX  J  for  a  complete  source  code  listing. 
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3.48.11  THETA_0 

THETA_0  is  a  constant  defining  the  reference  maximum  turn  angle  which  is 
scaled  for  speed. 

3.48.11.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


/’'#define  THETA_0  0.046542113  /’'0.013962634’'/ 

#define  THETA_0  nlos_miss_char[10] 


3.48.11.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.11.2.1  Algorithm 

THETA_0  is  not  used  in  the  current  calculations. 

See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.12  SIN.UNGUIDE 

SIN_UNGUIDE  is  a  constant  defining  the  sine  of  level  flight  [4.0  degrees 
pitch]  for  an  unguided  nlos  missile. 

3.48.12.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile  nlosjnit, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_nlos  init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  SIN_UNGUIDE  nlos_miss_char[ll] 
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3.48.12.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.12.2.1  Algorithm 

SIN_UNGUIDE  is  not  used  in  the  current  calculations. 

See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.13  COS_UNGUIDE 

COS_UNGUIDE  is  a  constant  defining  the  cosine  of  level  flight  [4.0  degrees 
pitch]  for  an  unguided  nlos  missile. 

3.48.13.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 

#define  COS_UNGUIDE  nlos_miss_char[12] 

3.48.13.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.13.2.1  Algorithm 

COS_UNGUIDE  is  not  used  in  the  current  calculations. 

See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.14  SIN_CLIMB 

SIN_CLIMB  is  a  constant  defining  the  sine  of  the  delta  pitch  angle  [3.5 

degrees]  for  a  climbing  nlos  missile. 

3.48.14.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
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sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  SIN_CLIMB  nlos_miss_char[13] 


3.48.14.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.14.2.1  Algorithm 

SIN_CLIMB  is  not  used  in  the  current  calculations. 

See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.15  COS_CLIMB 

C;OS_CLIMB  is  a  constant  defining  the  cosine  of  the  delta  pitch  angle  [3.5 
degrees]  for  a  climbing  nlos  missile. 

3.48.15.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 

#define  COS_CLIMB  nlos_miss_char[14] 


3.48.15.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.15.2.1  Algorithm 

COS_CLIMB  is  not  used  in  the  current  calculations. 

See  APPENDIX  }  for  a  complete  source  code  listing. 

3.48.16  SIN.LOCK 

SIN_LOCK  is  a  constant  defining  the  sine  of  the  lock  cone  angle  [9.0  degrees] 
for  a  locked-on  nlos  missile. 
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3.48.16.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  SIN_LOCK  nlos_miss_char[15] 


3.48.16.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.16.2.1  Algorithm 

SIN_LOCK  is  not  used  in  the  current  calculations. 

See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.17  COS_LOCK 

COS_LOCK  is  a  constant  defining  the  cosine  of  the  lock  cone  angle  [9.0 
degrees]  for  a  locked-on  nlos  missile. 

3.48.17.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequendally.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 

#define  COS_LOCK  nlos_miss_char[16] 


3.48.17.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.17.2.1  Algorithm 

COS_LOCK  is  not  used  in  the  current  calculations. 
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See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.18  COS_TERM 

COS_TERM  is  a  constant  defining  the  cosine  of  the  terminal  angle  [0.0 
degrees]  for  a  locked-on  nlos  missile. 

3.48.18.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  Missile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  COS_TERM  nlos_miss_char[17] 


3.48.18.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.18.2.1  Algorithm 

COS_TERM  is  not  used  in  the  current  calculations. 

See  APPENDIX  J  for  a  complete  source  code  listing. 

3.48.19  COS.LOSE 

COS_LOSE  is  a  constant  defining  the  cosine  of  the  angle  [20.0  degrees]  for  a 
loss-of-lock-on  nlos  missile. 

3.48.19.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.48.  -  NLOS  hfissile  Characteristics  Data  Array  for 
a  summary  of  the  constants  data. 


#define  COS_LOSE 


nlos_miss_char[18] 


-330- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


3.48.19.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.48.19.2.1  Algorithm 

COS_LOSE  is  not  used  in  the  current  calculations. 

See  APPENDIX  }  for  a  complete  source  code  listing. 

3.49  Nlos_miss_poly_deg 

The  nlos_miss_poly_deg  array  consists  of  values  of  the  degree  of  each 
polynomial  equation  used  to  compute  the  burn  speed,  and  the  coast  speed  for 
the  NLOS  missile. 

3.49.1  NLOS_BURN_SPEED_DEG 

NLOS_BURN_SPEED_DEG  is  a  constant  defining  the  polynomial  degree  for 
the  NLOS  missile  burn  speed  coefficient  data  array 

3.49.1.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weapons_init.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.49.  -  NLOS  Missile  Polynomial  Degree  Data 
Array  for  a  sxunmary  of  the  constants  data. 


#define  NLOS_BURN_SPEED_DEG  nlos_miss_poly_deg[0] 


3.49.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  NLOS_BURN_SPEED_DEG  is  4,  especially,  the  declared  size  of  the 
nlos_burn_speed_coeff  array  is  5. 

3.49.1.2.1  Algorithm 

NLOS_BURN_SPEED_DEG  is  not  used  in  the  current  calculations. 

See  APPENDIX  J  for  a  complete  source  code  listing. 
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3.49.2  NLOS_COAST_SPEED_DEG 

NLOS_COAST_SPEED_DEG  is  a  constant  defining  the  polynomial  degree  for 
the  NLOS  missile  coast  speed  coefficient  data  array. 

3.49.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  missile_nlos_init, 
called  by  CSC  weaponsjnit.  Execution  of  the  CSU  missile_nlos_init  is 
normally  done  only  once  during  CSCI  initialization  and  is  performed 
sequentially.  See  TABLE  5.1.49.  -  NLOS  Missile  Polynomial  Degree  Data 
Array  for  a  summary  of  the  constants  data. 


#define  NLOS_COAST_SPEED_DEG  nlos_miss_poly_deg[l] 


3.49.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed.  The  maximum 
value  for  NLOS_COAST_SPEED_DEG  is  4,  especially,  the  declared  size  of  the 
nlos_coast_speed_coeff  array  is  5. 

3.49.2.2.1  Algorithm 

NLOS_COAST_SPEED_DEG  is  not  used  in  the  current  calculations. 

See  APPENDIX  J  for  a  complete  source  code  listing. 

3.50  Nlos_burn_speed_coeff 

The  nlos_burn_speed_coeff  array  consists  of  the  coefficients  for  a  polynomial 
equation  defining  the  NLOS  missile  burn  speed  with  respect  to  time  m  the 
form  using  the  Newton-Raphson  method. 

3.50.1  Initialization 

The  nlos_burn_speed_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_nlos_init,  called  by  CSC  weaponsjnit.  Execution  of  the  CSU 
missile  nlosjnit  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.50.  -  NLOS  Missile  Burn  Speed 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 
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The  following  is  the  default  declaration. 


/V 

Coefficients  for  the  speed  polynomial  before  motor  burnout. 

/V 

static  REAL  nlos_burn_speed_coeff[5]  = 

{ 

0.03333333,  a_0  -  m/tick  (67.0  m/sec)  V 

1.25777777,  I*  a_l  -  m/tick**2  (274.9732662  m/sec*’'2) 

0.0, 

0.0, 

0.0 

}; 


The  array  has  a  maximum  size  of  5  elements. 

3.60.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
NLOS_BURN_SPEED_DEG  determines  the  number  of  elements  of  the  array 
to  be  used  in  the  polynomial  evaluation. 

3.50.2.1  Algorithm 

The  nlos_burn_speed_coeff  array  is  not  used  in  the  current  calculations  for 
NLOS  missile  burn  speed.  The  NLOS  missile  speed  profile  is  constant  in 
phase  one  and  phase  two,  using  a  time  as  the  delimiter. 

See  APPENDIX  J  for  a  complete  source  code  listing. 

3.51  Nlos_coast_speed_coeff 

The  nlos_coast_speed_coeff  array  consists  of  the  coefficients  for  a  polynomial 
equation  defining  the  NLOS  missile  coast  speed  with  respect  to  time  in  the 
form  using  the  Newton-Raphson  method. 

3.51.1  Initialization 

The  nlos_coast_speed_coeff  array  is  initialized  during  execution  of  the  CSU 
missile_nlos_init,  called  by  CSC  weapons_init.  Execution  of  the  CSU 
missile_nlos_init  is  normally  done  only  once  during  CSCI  initialization  and 
is  performed  sequentially.  See  TABLE  5.1.51.  -  NLOS  Missile  Coast  Speed 
Coefficient  Data  Array  for  a  summary  of  the  array  data. 
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/V 

*  Coefficients  for  the  speed  polynomial  after  motor  burnout. 

/V 


static  REAL  nlos_coast_speed_coeff[5]  = 


30.46972849, 

-9.7721160e-2, 

1.2433925e-4, 

-5.4061501e-8, 

0.0 


/=^a_0-m/tick  (327.2858074  m/ sec)  V 
/*  a_l  -  m/tick=^*2  (-21.4609544  m/sec=^=^2) 

I*  a_2  -  m/tick’^’^3  (  0.8227650  m/sec’^’^3)  V 
I*  a_3  -  m/tick*M  ( -0.0133200  m/sec*M)  V 


}; 


The  array  has  a  maximum  size  of  5  elements. 

3.61.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
NLOS_COAST_SPEED_DEG  determines  the  number  of  elements  of  the  array 
to  be  used  in  the  polynomial  evaluation. 

3.51.2.1  Algorithm 

The  nlos_coast_speed_coeff  array  is  not  used  in  the  current  calculations  for 
NLOS  missile  coast  speed.  The  NLOS  missile  speed  profile  is  constant  in 
phase  one  and  phase  two,  using  a  time  as  the  delimiter. 

See  APPENDIX  J  for  a  complete  source  code  listing. 

3.52  Hydra_rkt_char 

The  hydra_rkt_char  array  consists  of  characteristics  and  parameters  describing 
a  rocket  launcher  system  and  its  performance  constraints. 

3.52.1  HYDRA_LAUNCHER_POS_X 

HYDRA_LAUNCHER_POS_X  is  a  constant  defining  the  hydra  launcher 
position  in  the  x-axis. 

3.52.1.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  hydrajnit,  called  by 
CSC  weaponsjnit.  Execution  of  the  CSU  hydrajnit  is  normally  done  only 
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once  during  CSCI  initialization  and  is  performed  sequentially.  See  TABLE 
5.1.52.  -  Hydra  Rocket  Configuration  Data  Array  for  a  summary  of  the 
constant. 

#define  HYDRA_LAUNCHER_POS_X  hydra_rkt_char[0] 


3.52.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.52.1.2.1  Algorithm 

HYDRA_LAUNCHER_POS_X  is  used  to  initialize  the  left  and  right  launcher 
position,  rotational  elements,  and  offset  positions  in  the  x-axis  in  a  call  to  the 
CSU  hydrajnit. 

,  left_launcher_pos[0]  =  HYDRA_LAUNCHER_POS_X; 
right_launcher_pos[0]  =  HYDRA_LAUNCHER_POS_X; 
articulation_pos[l]  =  HYDRA_LAUNCHER_POS_Y; 
articulation_pos[2]  =  HYDRA_LAUNCHER_POS_Z; 

if(!rotate_init_element(  &articulation_element,  hullO, 

1.0, 0.0, 0.0, 0.0, 

ARTICUL  ATION_MIN,  ARTICUL  ATION_M  AX,  /  *TWO_*  /  PI,  /  "^ra  te  V 
0.0,  HYDRA_LAUNCHER_POS_Y, 
HYDRA_LAUNCHER_POS_Z  )) 

printfC  "Rotate_Init_Element;  articulation_element  FAILEDXn"  ); 

} 

rotate_init_element(  &pylon_L_element,  articulationO,  0.0,  0.0,  1.0,  0.0, 
-TWO_PI,  TWO_PI,  TWO_PI,  /*Tate*/ 
-HYDRA_LAUNCHER_POS_X,  0.0,  0.0 ); 
rotate_init_element(  &pylon_R_element,  articulationO,  0.0,  0.0,  1.0,  0.0, 
-TWO_PI,  TWO_PI,  TWO_PI,  /’^rateV 
HYDRA_LAUNCHER_POS_X,  0.0,  0.0  ); 
missile_hydra_init(  hydras,  MAX_HYDRA70_ROCKET  ); 
missile_hydra_set_pylon_position_offsets( 

HYDRA_LAUNCHER_POS_X, 
HYDRA_LAUNCHER_POS_Y, 
HYDRA_LAUNCHER_POS_Z  ); 
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See  APPENDIX  N  for  a  complete  source  code  listing. 

3.52.2  HYDRA_LAUNCHER_POS_Y 

HYDRA_LAUNCHER_POS_Y  is  a  constant  defining  the  hydra  launcher 
position  in  the  y-axis. 

3.52.2.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  hydra_init,  called  by 
CSC  weaponsjnit.  Execution  of  the  CSU  hydrajnit  is  normally  done  only 
once  during  CSCI  initialization  and  is  performed  sequentially.  See  TABLE 
5.1.52.  -  Hydra  Rocket  Configuration  Data  Array  for  a  summary  of  the 
constant. 


#define  HYDRA_LAUNCHER_POS_Y  hydra_rkt_char[l] 

j 

3.'52.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.52.2.2.1  Algorithm 

HYDRA_LAUNCHER_POS_Y  is  used  to  initialize  the  left  and  right  launcher 
position,  rotational  elements,  and  offset  positions  in  the  y-axis  in  a  call  to  the 
CSU  hydra_init. 


lef  t_launcher_pos  [0]  =  HYDRA_LAUNCHER_POS_X; 
right_launcher_pos[0]  =  HYDRA_LAUNCHER_POS_X; 
articulation_pos[l]  =  HYDRA_LAUNCHER_POS_Y; 
articulation_pos[2]  =  HYDRA_LAUNCHER_POS_Z; 

if(!rotate_init_element(  &articulation_element,  hullO, 

1.0,  0.0, 0.0, 0.0, 

ARTICUL  ATION_MIN,  ARTICUL  ATION_M  AX,  /  ■^TWO_  V  PI,  /  a  te”^  / 
0.0,  HYDRA_LAUNCHER_POS_Y, 
HYDRA_LAUNCHER_POS_Z  )) 

{ 

printff  "Rotate_Init_Element:  articulation_element  FAILEDXn"  ); 
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rotate_init_element(  &pylon_L_element,  articulationO,  0.0,  0.0,  1.0,  0.0, 
-TWO_PI,  TWO_PI,  TWO_PI,  /*rateV 
-HYDRA_LAUNCHER_POS_X,  0.0,  0.0  ); 
rotate_mit_element(  &pylon_R_element,  articulationO,  0.0,  0.0,  1.0,  0.0, 
-TWO_PI,  TWO_PI,  TWO_PI,  /*rateV 
HYDRA_LAUNCHER_POS_X,  0.0,  0.0 ); 
missile_hydra_init(  hydras,  MAX_HYDRA70_ROCKET  ); 
missile_hydra_set_pylon_position_offsets( 

HYDRA_LAUNCHER_POS_X, 
HYDRA_LAUNCHER_POS_Y, 
HYDRA_LAUNCHER_POS_Z  ); 


See  APPENDIX  N  for  a  complete  source  code  listing. 

3.52.3  HYDRA_LAUNCHER_POS_Z 

HYDRA_LAUNCHER_POS_Z  is  a  constant  defining  the  hydra  launcher 
position  in  the  z-axis. 

$ 

3.52.3.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  hydrajnit,  called  by 
CSC  weaponsjnit.  Execution  of  the  CSU  hydrajnit  is  normally  done  only 
once  during  CSCI  initialization  and  is  performed  sequentially.  See  TABLE 
5.1.52.  -  Hydra  Rocket  Configuration  Data  Array  for  a  summary  of  the 
constant. 


#define  HYDRA_LAUNCHER_POS_Z  hydra_rkt_char[2] 


3.52.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.52.3.2.1  Algorithm 

HYDRA_LAUNCHER_POS_Z  is  used  to  initialize  the  left  and  right  launcher 
position,  rotational  elements,  and  offset  positions  in  the  z-axis  in  a  call  to  the 
CSU  hydrajnit. 

leftjauncher_pos[0]  =  HYDRA_LAUNCHER_POS_X; 
right_launcher_pos[0]  =  HYDRA_LAUNCHER_POS_X; 
articulation_pos[l]  =  HYDRA_LAUNCHER_POS_Y; 

_ articulation_pos[2]  =  HYDRA_LAUNCHER_POS_Z; _ 
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if(!rotate_init_element(  &articulation_element,  hullO, 

1.0,  0.0,  0.0,  0.0, 

ARTICULATION_MIN,ARTICULATION_MAX,/*TWO_VPI,/*rateV 
0.0,  HYDRA_LAUNCHER_POS_Y, 
HYDRA_LAUNCHER_POS_Z  )) 

printff  "Rotate_Init_Element:  articulation_element  FAILED\n"  ); 


rotate_init_element(  &pylon_L_element,  articulationO,  0.0,  0.0,  1.0,  0.0, 
-TWO_PI,  TWO_PI,  TWO_PI,  /*rateV 
-HYDRA_LAUNCHER_POS_X,  0.0,  0.0  ); 
rotate_init_element(  &pylon_R_element,  articulationO,  0.0,  0.0,  1.0,  0.0, 
-TWO_PI,  TWO_PI,  TWO_PI,  /“"rate*/ 
HYDRA_LAUNCHER_POS_X,  0.0,  0.0 ); 
missile_hydra_init(  hydras,  MAX_HYDRA70_ROCKET  ); 
missile_hydra_set_pylon_position_offsets( 

HYDRA_LAUNCHER_POS_X, 
HYDRA_LAUNCHER_POS_Y, 
HYDRA_LAUNCHER_POS_Z  ); 


See  APPENDIX  N  for  a  complete  source  code  listing. 

3.52.4  SOVIET_ARTICULATION 

SOVIET_ARTICULATION  is  a  constant  defining  the  angle  of  Soviet 
articulation  in  mils. 

3.52.4.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  hydrajnit,  called  by 
CSC  weapons_init.  Execution  of  the  CSU  hydra_init  is  normally  done  only 
once  during  CSCI  initialization  and  is  performed  sequentially.  See  TABLE 
5.1.52.  -  Hydra  Rocket  Configuration  Data  Array  for  a  summary  of  the 
constant. 


#define  SOVIET, ARTICULATION  (  mil_to_rad(hydra_rkt_char[3])) 


3.52.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.52.4.2.1  Algorithm 

SOVIET_ARTICULATION  is  not  used  in  the  current  calculations. 

See  APPENDIX  N  for  a  complete  source  code  listing. 

3.52.5  HULL_NEG_5_PITCH 

HULL_NEG_5_PITCH  is  a  constant  defining  the  degrees  of  hull  negative 
pitch. 

3.52.5.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  hydrajnit,  called  by 
CSC  weaponsjnit.  Execution  of  the  CSU  hydrajnit  is  normally  done  only 
once  during  CSCI  initialization  and  is  performed  sequentially.  See  TABLE 
5.1.52.  -  Hydra  Rocket  Configuration  Data  Array  for  a  summary  of  the 
constant. 


#clefine  HULL_NEG_5_PrrCH  (  deg_to_rad(hydra_rkt_char[4])) 


3.52.5.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.52.5.2,1  Algorithm 

HULL_NEG_5_PITCH  is  used  to  compute  the  super  elevation  of  the  pylon 
articulation  in  the  CSU  hydra_set_pylon_articulation. 


*  Get  rocket  range  &  calculate  SuperElevation  and  Dispersion  angles 

V 

pylons_set  =  FALSE; 
if(  mun_data->data.rocket.articulation  ) 
range  =  weapons_get_rocket_range(); 
else 

range  =  (REAL)(mun_data->data.rocket.flyout_range); 

*  Set  pylon  Super  Elevation  angle  &  pylon  Dispersion  angle 

V 

missile_hydra_set_pylon_articulation(  range,  warhead_class, 

&flight_time, 

_ &super_elev,  &dispersion  ); _ 
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super_elev  +=  HULL_NEG_5_PITCH; 
rotate_set_angle(  articulationO,  super_elev  ); 
rotate_set_angle(  pylon_R(),  (-  dispersion)  ); 
rotate_set_angle(  pylon_L(),  dispersion  ); _ 

See  APPENDIX  N  for  a  complete  source  code  listing. 

3.52.6  ARTICULATION_MAX 

ARTICULATION_MAX  is  a  constant  defining  the  degress  of  maximum 
articulation. 

3.52.6.1  Initialization 

The  constant  is  initialized  during  execution  of  the  CSU  hydra_init,  called  by 
CSC  weaponsjnit.  Execution  of  the  CSU  hydrajnit  is  normally  done  only 
once  during  CSCI  initialization  and  is  performed  sequentially.  See  TABLE 
5.1.52.  -  Hydra  Rocket  Configuration  Data  Array  for  a  summary  of  the 
constant. 

t  . . . . . 

#define  ARTICULATION_MAX  (  deg_to_rad(hydra_rkt_char[5])) 


3.52.6.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.52.6.2.1  Algorithm 

ARTICULATION_MAX  is  used  to  limit  the  initialization  of  the  rotation 
element  in  the  call  to  the  CSU  hydra_init. 


if(!rotate_init_element(  &articulation_element,  hullO, 

1.0, 0.0, 0.0, 0.0, 

ARTICULAHON_MIN,ARTICULATION_MAX, 

/’^TWO_’^/PI, 

/*rate*/ 

0.0,  HYDRA_LAUNCHER_POS_Y, 
HYDRA_LAUNCHER_POS_Z  )) 


See  APPENDIX  N  for  a  complete  source  code  listing. 
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3.53.1  M151_BURST_SPREAD 

M151_BURST_SPREAD  is  a  constant  defining  the  radius  of  the  M151  burst 
spread,  especially,  the  M151  is  twin  bursts  3  meters  apart. 

3.53.1.1  Initialization 

M151_BURST_SPREAD  is  initialized  during  execution  of  the  CSU 
missile_hydra_init,  called  by  CSU  hydra_init.  See  TABLE  5.1.53.  -  Hydra 
Rocket  Characteristics  Data  Array  for  a  summary  of  the  constant. 
M151_BURST_SPREAD  is  also  known  as  rkt_hydra_char[  0]. 

The  following  declaration  sets  the  default  values. 


static  REAL  rkt_hydra_char[12]  = 


{ 


M151_BURST_SPREAD, 
JV[261_BURST_HEIGHT, 
M261_BURST_RANGE, 
M261_BURST_SPREAD, 
M255_BURST_RANGE, 
M255_BURST_SPREAD, 
FLECH_60_MAX_RANGE, 
50.0, 

5000.0, 


/*  twin  bursts  are  3  m  apart 
I*  release  submunitions  180  ft  *! 

0  m  in  front  of  target  (49  ?)  *! 

I*  twin  bursts  are  13  m  apart  *! 

I*  release  darts  150  m  front  of  tgt  *! 

I*  twin  bursts  are  35  m  apart  */ 

/*  darts  fly  total  of  750  m  */ 

/*  hydra  minimum  range  */ 

/*  hydra  maximum  range  for  Soviet  S-5  57mm  Rocket  */ 


7000.0, 

7000.0, 

3200.0 

}; 


/*  hydra  maximum  range  for  _M151  [actual  9000  m]  */ 
/*  hydra  maximum  range  for  M261  */ 

/*  hydra  maximum  range  for  M255  */ 


3.53.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.53.1.2.1  Algorithm 

Rkt_hydra_char[  0]  is  used  to  compute  the  lead_angle  when  the  type  of  rocket 
is  HE  with  10  LB  warhead  by  a  call  to  the  CSU 
missile_hydra_set_pylon_articulation. 
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case  ROCKET_HE:  I*  type  101b  WARHEAD  */ 

if(  range  >  HYDRA_MAX_RANGE_M151  ) 
range  =  HYDRA_MAX_RANGE_M151; 
ball_range  =  range  /  speedjactor; 
missile_util_ballistics_calc_traj(  ball_table,  table_size, 
ball_range,  0.0,  0.0, 
time,  se_angle ); 

*lead_angle  =  atan(  (rkt_hydra_char[  0]  -  pylon_x)  /  range  ); 
*time  =  -5;  /*  Does  not  have  a  timed  fuze  *! 

break; 


See  APPENDIX  M  for  a  complete  source  code  listing. 

3.53.2  M261_BURST_HEIGHT 

M261_BURST_HEIGHT  is  a  constant  defining  the  height  of  release  for  the 
M261  burst,  especially,  release  of  submunitions  at  180  feet  above  the  ground 
level. 

3.53.2.1  Initialization 

M261_BURST_HEIGHT  is  initialized  during  execution  of  the  CSU 
missile_hydra_init,  called  by  CSU  hydra_init.  See  TABLE  5.1.53.  -  Hydra 
Rocket  Characteristics  Data  Array  for  a  summary  of  the  constant. 
M261_BURST_HEIGHT  is  also  known  as  rkt_hydra_char[  1]. 
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The  following  declaration  sets  the  default  values. 


static  REAL  rkt_hydra_char[12]  = 


{ 


M151_BURST_SPREAD, 
M261_BURST_HEIGHT, . 
M261_BURST_RANGE, 
M261_BURST_SPREAD, 
M255_BURST_RANGE, 
M255_BURST_SPREAD, 
FLECH_60_MAX_RANGE, 
50.0, 

5000.0, 


/*  twin  bursts  are  3  m  apart 
I*  release  submunitions  180  ft  */ 

0  m  in  front  of  target  (49  ?)  */ 

/*  twin  bursts  are  13  m  apart  */ 

!*  release  darts  150  m  front  of  tgt  */ 

/*  twin  bursts  are  35  m  apart  */ 

/*  darts  fly  total  of  750  m  */ 

/*  hydra  minimum  range  */ 

/*  hydra  maximum  range  for  Soviet  S-5  57mm  Rocket  */ 


7000.0, 

7000.0, 

3200.0 

1; 


/*  hydra  maximum  range  for  _M151  [actual  9000  m]  */ 
I*  hydra  maximum  range  for  M261  * ! 

I*  hydra  maximum  range  for  M255  * ! 


3.53.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 


3.53.2.2.1  Algorithm 

Rkt_hydra_char[  1]  is  used  to  compute  ballistics  trajectory  when  the  rocket  is 
a  type  MPSM  by  a  call  to  the  CSU  missile_hydra_set_pylon_articulation. 


case  ROCKET_MPSM:  / *  type  MPSM  V 

if(  range  >  HYDRA_MAX_RANGE_M261  ) 
range  =  HYDRA_MAX_RANGE_M261; 
ball_range  =  range  /  speed_factor; 
missile_util_ballistics_calc_traj(  ball_table,  table_size, 
ball_range,  0.0,  rkt_hydra_char[  1], 
time,  se_angle ); 

*lead_angle  =  atan(  (rkt_hydra_char[  3]  -  pylon_x)  /  range  ); 
break; 
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Rkt_hydra_char[  1]  is  assigned  to  submunition  impact  height  when  the 
rocket  is  a  type  MPSM  by  a  call  to  the  CSU  missile_hydrajire. 


case  ROCKET_MPSM:  I*  Multi-Purpose  Sub-Munition 

bmptr->max_range  =  HYDRA_MAX_RANGE_M261; 
rkt->sub_mun_type  =  SUB_MUN_IMPACT; 
rkt->sub_ammo_type  =  munition_US_M73; 
rkt->sub_munition. impact,  ammo  =  munition_US_M73; 
rkt->sub_munition.impact.fuze  =  munition_US_M433; 
rkt->sub_munition.impact.quantity  =  m73_per_m261_burst; 
rkt->sub_munition.impact.height  =  rkt_hydra_char[  1]; 
fuze  =  munition_US_M439; 
break; 


See  APPENDIX  M  for  a  complete  source  code  listing. 

3.53.3  M261_BURST_RANGE 

f 

M261_BURST_RANGE  is  a  constant  defining  the  distance  from  the  target  to 
the  burst,  especially,  for  the  M261  burst  at  0  meters  in  front  of  target. 

3.53.3.1  Initialization 

M261_BURST_RANGE  is  initialized  during  execution  of  the  CSU 
missile_hydra_init,  called  by  CSU  hydra_init.  See  TABLE  5.1.53.  -  Hydra 
Rocket  Characteristics  Data  Array  for  a  summary  of  the  constant. 
M261_BURST_RANGE  is  also  known  as  rkt_hydra_char[  2]. 
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The  following  declaration  sets  the  default  values. 


static  REAL  rkt_hydra_char[12]  = 

{ 

M151_BURST_SPREAD,  I*  twin  bursts  are  3  m  apart  *! 
M261_BURST_HEIGHT,  /*  release  submunitions  180  ft 
M261_BURST_RANGE,  /*  0  m  in  front  of  target  (49  ?) 
M261_BURST_SPREAD,  /*  twin  bursts  are  13  m  apart  */ 
M255_BURST_RANGE,  I*  release  darts  150  m  front  of  tgt  *! 
M255_BURST_SPREAD,  ■  I*  twin  bursts  are  35  m  apart  */ 
FLECH_60_MAX_RANGE,  I*  darts  fly  total  of  750  m  */ 

50.0,  I*  hydra  minimum  range  */ 

5000.0,  /*  hydra  maximum  range  for  Soviet  S-5  57mm  Rocket  * ! 

7000.0,  I*  hydra  maximum  range  for  _M151  [actual  9000  m]  * ! 

7000.0,  I*  hydra  maximum  range  for  M261  *! 

3200.0  !*  hydra  maximum  range  for  M255  * ! 

}; 

% 

3.53.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.53.3.2.1  Algorithm 

Rkt_hydra_char[  21  is  not  used  in  the  current  calculations. 

See  APPENDIX  M  for  a  complete  source  code  listing. 

3.53.4  M261_BURST_SPREAD 

M261_BURST_SPREAD  is  a  constant  defining  the  radius  of  the  M261  burst 
spread,  especially,  the  M261  is  twin  bursts  13  meters  apart. 

3.53.4.1  Initialization 

M261_BURST_SPREAD  array  is  initialized  during  execution  of  the  CSU 
missile_hydra_init,  called  by  CSU  hydra_init.  See  TABLE  5.1.53.  -  Hydra 
Rocket  Characteristics  Data  Array  for  a  summary  of  the  constant. 
M261_BURST_SPREAD  is  also  known  as  rkt_hydra_char[  3]. 
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The  following  declaration  sets  the  default  values. 


static  REAL  rkt_hydra_char[12]  = 

{ 

M151_BURST_SPREAD,  I*  twin  bursts  are  3  m  apart  */ 
M261_BURST_HEIGHT,  I*  release  submunitions  180  ft 
M261_BURST_:RANGE,  0  m  in  front  of  target  (49  ?)  *! 

M261_BURST_SPREAD,  I*  twin  bursts  are  13  m  apart 
M255_BURST_RANGE,  /*  release  darts  150  m  front  of  tgt  *! 
M255_BURST_SPREAD,  -  j*  twin  bursts  are  35  m  apart  *! 

FLECH_60_MAX_RANGE,  I*  darts  fly  total  of  750  m  *! 

50.0,  I*  hydra  minimum  range  */ 

5000.0,  /*  hydra  maximum  range  for  Soviet  S-5  57mm  Rocket  *! 

7000.0,  I*  hydra  maximum  range  for  _M151  [actual  9000  m]  * ! 

7000.0,  I*  hydra  maximum  range  for  M261 

3200.0  I*  hydra  maximum  range  for  M255  *! 

}; 

3.53.4.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.53.4.2.1  Algorithm 

Rkt_hydra_char[  3]  is  used  to  compute  the  lead  angle  when  the  rocket  is  a 
type  MPSM  by  a  call  to  the  CSU  missile_hydra_set_pylon_articulation. 


case  ROCKET_MPSM:  /  type  MPSM  V 

if(  range  >  HYDRA_MAX_RANGE_M261  ) 
range  =  HYDRA_MAX_RANGE_M261; 
ball_range  =  range  /  speed_factor; 
missile_util_ballistics_calc_traj(  ball_table,  table_size, 
ball_range,  0.0,  rkt_hydra_char[  1], 
time,  se_angle ); 

*lead_angle  =  atan(  (rkt_hydra_char[  3]  -  pylon_x)  /  range  ); 
break; 


See  APPENDIX  M  for  a  complete  source  code  listing. 
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3.53.5  M255_BURST_RANGE 

M255_BURST_RANGE  is  a  constant  defining  the  distance  from  the  target  to 
the  burst,  especially,  for  the  M255  burst  at  150  meters  in  front  of  target. 

3.53.5.1  Initialization 

M255_BURST_RANGE  is  initialized  during  execution  of  the  CSU 
missile_hydra_init,  called  by  CSU  hydra_init.  See  TABLE  5.1.53.  -  Hydra 
Rocket  Characteristics  Data  Array  for  a  summary  of  the  constant. 
M255_BURST_RANGE  is  also  known  as  rkt_hydra_char[  4]. 

The  following  declaration  sets  the  default  values. 


static  REAL  rkt_hydra_char[12]  = 

{ 


M151_BURST_SPREAD, 
M261_BURST_HEIGHT, 
’M261_BURST_RANGE, 
M261_BURST_SPREAD, 
M255_BURST_RANGE, 
M255_BURST_SPREAD, 
FLECH_60_MAX_RANGE, 
50.0, 

5000.0, 


/*  twin  bursts  are  3  m  apart 
I*  release  submunitions  180  ft  */ 

/*  0  m  in  front  of  target  (49  ?)  *! 

/*  twin  bursts  are  13  m  apart  */ 

/*  release  darts  150  m  front  of  tgt  */ 

/*  twin  bursts  are  35  m  apart  */ 

/*  darts  fly  total  of  750  m  */ . 

/*  hydra  minimum  range  */ 

/*  hydra  maximum  range  for  Soviet  S-5  57mm  Rocket  */ 


7000.0, 

7000.0, 

3200.0 


}; 


/*  hydra  maximum  range  for  _M151  [actual  9000  m]  */ 
/*  hydra  maximum  range  for  M261  */ 

/*  hydra  maximum  range  for  M255  */ 


3.53.5.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.53.5.2.1  Algorithm 

Rkt_hydra_char[  4]  is  used  to  compute  ballistics  trajectory  and  lead  angle 
when  the  rocket  is  a  type  FLECHETTE  by  a  call  to  the  CSU 
missile_hydra_set_pylon_articulation. 
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case  ROCKET_FLECHETTE:  I*  type  FLECHETTE  V 

if(  range  >  HYDRA_MAX_RANGE_M255  ) 
range  =  HYDRA_MAX_RANGE_M255; 
ball_range  =  range  /  speedjactor; 
missile_util_ballistics_calc_traj(  ball_table,  table_size, 
ball_range,  rkt_hydra_char[  4],  0.0, 
time,  se_angle ); 

*lead_angle  =  atan((rkt_hydra_char[  5]  -  pylon_x)  / 

(range  -  rkt_hydra_char[  4])); 

break; 


See  APPENDIX  M  for  a  complete  source  code  listing. 

3.53.6  M255_BURST_SPREAD 

M255_BURST_SPREAD  is  a  constant  defining  the  radius  of  the  M255  burst 
spread,  especially,  the  M255  is  twin  bursts  35  meters  apart. 

I 

3.53.6.1  Initialization 

M255_BURST_SPREAD  is  initialized  during  execution  of  the  CSU 
missile.hydrajnit,  called  by  CSU  hydrajnit.  See  TABLE  5.1.53.  -  Hydra 
Rocket  Characteristics  Data  Array  for  a  summary  of  the  constant. 
M255_BURST_SPREAD  is  also  known  as  rkt_hydra_char[  5]. 
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The  following  declaration  sets  the  default  values. 


static  REAL  rkt_hydra_char[12]  = 


M151_BURST_SPREAD, 
M261_BURST_HEIGHT, 
M261_BURST_RANGE, 
M261_BURST_SPREAD, 
M255_BURST_RANGE, 
M255_BURST_SPREAD, 
FLECH_60_MAX_RANGE, 
50.0,  I*  hydra 

5000.0,  I*  hydra 


7000.0, 

7000.0, 

3200.0 


READ,  I*  twin  bursts  are  3  m  apart  *! 
ilGHT,  I*  release  subnaunitions  180  ft  *! 

^NGE,  /*  0  m  in  front  of  target  (49  ?)  *! 

READ,  !*  twin  bursts  are  13  m  apart  */ 

^.NGE,  I*  release  darts  150  na  front  of  tgt  * ! 

READ,  I*  twin  bursts  are  35  m  apart  * ! 

_RANGE,  I*  darts  fly  total  of  750  m  *! 

I*  hydra  minimum  range  * ! 

I*  hydra  maximum  range  for  Soviet  S-5  57mm  Rocket  */ 


J 

I*  hydra  maximum  range  for  _M151  [actual  9000  m]  *! 
I*  hydra  maximum  range  for  M261  * ! 

/*  hydra  maximum  range  for  M255  */ 


3.53.6.2 


Usage 


During  real-time  execution,  this  constant  is  not  recomputed. 

3.53.6.2.1  Algorithm 

Rkt_hydra_char[  5]  is  used  to  compute  ballistics  trajectory  and  lead  angle 
when  the  rocket  is  a  type  FLECHETTE  by  a  call  to  the  CSU 
missile_hydra_set_pylon_articulation. 


case  ROCKET_FLECHETTE:  /  type  FLECHETTE  V 

if(  range  >  HYDRA_MAX_RANGE_M255  ) 
range  =  HYDRA_MAX_RANGE_M255; 
ball_range  =  range  /  speed_factor; 
missile_util_ballistics_calc_traj(  ball_table,  table_size, 
ball_range,  rkt_hydra_char[  4],  0.0, 
time,  se_angle ); 

Tead_angle  =  atan((rkt_hydra_char[  5]  -  pylon_x)  / 

(range  -  rkt_hydra_char[  4])); 

break; 


See  APPENDIX  M  for  a  complete  source  code  listing. 
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3.53.7  FLECH_60_MAX_RANGE 

FLECH_60_MAX_RANGE  is  a  constant  defining  the  total  distance  the  darts 
fly  in  meters  after  the  proximity  fuze  detonates.  At  the  maximum  range,  the 
flechette  rounds  have  lost  the  momentum  and  fall  to  the  ground. 

3.53.7.1  Initialization 

FLECH_60_MAX_RANGE  is  initialized  during  execution  of  the  CSU 
missile_hydra_init,  called  by  CSU  hydrajnit.  See  TABLE  5.1.53.  -  Hydra 
Rocket  Characteristics  Data  Array  for  a  summary  of  the  constant. 
FLECH_60_MAX_RANGE  is  also  known  as  rkt_hydra_char[  6]. 

The  following  declaration  sets  the  default  values. 


static  REAL  rkt_hydra_char[12]  = 


{ 


M151_BURST_SPREAD, 
'M261_BURST_HEIGHT, 
M261_BURST_RANGE, 
M261_BURST_SPREAD, 
M255_BURST_RANGE, 
M255_BURST_SPREAD, 
FLECH_60_MAX_RANGE, 
50.0, 

5000.0, 


I*  twin  bursts  are  3  m  apart  *! 

/*  release  submunitions  180  ft  */ 

/*  0  m  in  front  of  target  (49  ?)  */ 

/*  twin  bursts  are  13  m  apart 
/*  release  darts  150  m  front  of  tgt  */ 

/*  twin  bursts  are  35  m  apart  */ 

/*  darts  fly  total  of  750  m  */ 

/*  hydra  minimum  range  */ 

/*  hydra  maximiun  range  for  Soviet  S-5  57mm  Rocket  */ 


7000.0, 

7000.0, 

3200.0 

}; 


/*  hydra  maximum  range  for  _M151  [actual  9000  m]  */ 
/*  hydra  maximum  range  for  M261  */ 

/*  hydra  maximum  range  for  M255  */ 


3.53.7.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.53.7.2.1  Algorithm 

FLECH_60_MAX_RANGE  is  not  used  in  the  current  calculations. 

See  APPENDIX  M  for  a  complete  source  code  listing. 

3.53.8  HYDRA_MIN_RANGE 

HYDRA_MIN_RANGE  is  a  constant  defining  the  hydra  minimum  range. 
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3.53.8.1 


HYDRA_MIN_RANGE  is  initialized  during  execution  of  the  CSU 
missile_hydra_init,  called  by  CSU  hydrajnit.  See  TABLE  5.1.53.  -  Hydra 
Rocket  Characteristics  Data  Array  for  a  summary  of  the  constant. 


#define  HYDRA_MIN_RANGE  rkt_hydra_char[  7] 


The  following  declaration  sets  the  default  values. 


static  REAL  rkt_hydra_char[12]  = 


M151_BURST_SPREAD, 
M261_BURST_HEICHT, 
M261_BURST_RANCE, 
M261_BURST_SPREAD, 

'  M255_BURST_RANCE, 
M255_BURST_SPREAD, 
FLECH_60_MAX_RANCE, 
50.0, 

5000.0, 


I*  twin  bursts  are  3  m  apart  *! 

!*  release  submunitions  180  ft  *! 

/*  0  m  in  front  of  target  (49  ?)  *! 

I*  twin  bursts  are  13  m  apart  *! 

I*  release  darts  150  m  front  of  tgt  *! 

I*  twin  bursts  are  35  m  apart  */ 

/*  darts  fly  total  of  750  m  */ 

/*  hydra  minimum  range  */ 

/*  hydra  maximum  range  for  Soviet  S-5  57mm  Rocket  */ 


7000.0, 

7000.0, 

3200.0 

}; 


hydra  maximum  range  for  _M151  [actual  9000  m]  *! 
I*  hydra  maximum  range  for  M261  *! 

I*  hydra  maximum  range  for  M255  */ 


3.53.8.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.53.8.2.1  Algorithm 

HYDRA_MIN_RANGE  is  used  to  limit  the  range  to  the  target  by  a  call  to  the 
CSU  missile_hydra-set_pylon_articulation. 


if(  tgt_range  <  HYDRA_MIN_RANGE  ) 
range  =  HYDRA_MIN_RANGE; 
else  if((  max_range_limit  >  0.0  )  && 

( tgt_range  >  max_range_lin^it ) ) 
range  =  max_range_limit;  _ 
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else 

range  =  tgt_range; 


See  APPENDIX  M  for  a  complete  source  code  listing. 

3.53.9  HYDRA_MAX_RANGE_S5 

HYDRA_MAX_RANGE_S5  is  a  constant  defining  the  hydra  maximum 
range  for  Soviet  S-5  57mm  rocket. 

3.53.9.1  Initialization 

HYDRA_MAX_RANGE_S5  is  initialized  during  execution  of  the  CSU 
missile_hydra_init,  called  by  CSU  hydra_mit.  See  TABLE  5.1.53.  -  Hydra 
Rocket  Characteristics  Data  Array  for  a  summary  of  the  constant. 

#define  HYDRA_MAX_RANGE_S5  rkt_hydra_char[  8] 


The  following  declaration  sets  the  default  values. 


static  REAL  rkt_hydra_char[12]  = 

{ 


M151_BURST_SPREAD, 
M261_BURST_HEIGHT, 
M261_BURST_RANGE, 
M261_BURST_SPREAD, 
M255_BURST_RANGE, 
M255_BURST_SPREAD, 
FLECH_60_MAX_RANGE, 
50.0, 

5000.0, 


/*  twin  bursts  are  3  m  apart  */ 

/*  release  submunitions  180  ft  */ 

/*  0  m  in  front  of  target  (49  ?)  */ 

/*  twin  bursts  are  13  m  apart  */ 

/*  release  darts  150  m  front  of  tgt  */ 

/*  twin  bursts  are  35  m  apart  * ! 

I*  darts  fly  total  of  750  m  * ! 

I*  hydra  minimum  range  * ! 

/*  hydra  maximum  range  for  Soviet  S-5  57mm  Rocket  *! 


7000.0, 

7000.0, 

3200.0 


I*  hydra  maximum  range  for  _M151  [actual  9000  m]  * ! 
/*  hydra  maximum  range  for  M261  */ 

/*  hydra  maximum  range  for  M255  */ 


3.53.9.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.53.9.2.1  Algorithm 

HYDRA_MAX_RANGE_S5  is  not  used  in  the  current  calculations. 

See  APPENDIX  M  for  a  complete  source  code  listing. 

3.53.10  HYDRA_MAX_RANGE_M151 

HYDRA_MAX_RANGE_M151  is  a  constant  defining  the  hydra  maximum 
range  for  the  M151. 

3.53.10.1  Initialization 

HYDRA_MAX_RANGE_M151  array  is  initialized  during  execution  of  the 
CSU  missile_hydra_init,  called  by  CSU  hydrajnit.  See  TABLE  5.1.53.  -  Hydra 
Rocket  Characteristics  Data  Array  for  a  summary  of  the  constant. 


#define  HYDRA_MAX_RANGE_M151  rkt_hydra_char[  9] 


The  following  declaration  sets  the  default  values. 


static  REAL  rkt_hydra_char[12]  = 


{ 


M151_BURST_SPREAD, 
M261_BURST_HEIGHT, 
M261_BURST1RANGE, 
M261_BURST_SPREAD, 
M255_BURST_RANGE, 
M255_BURST_SPREAD, 
FLECH_60_MAX_RANGE, 
50.0, 

5000.0, 


7000.0, 

7000.0, 

3200.0 

}; 


/*  twin  bursts  are  3  m  apart  */ 

/*  release  submunitions  180  ft  */ 

0  m  in  front  of  target  (49  ?)  */ 

/*  twin  bursts  are  13  m  apart  */ 

/*  release  darts  150  m  front  of  tgt  */ 

/*  twin  bursts  are  35  m  apart  */ 

/*  darts  fly  total  of  750  m 
!*  hydra  minimum  range  */ 

/*  hydra  maximum  range  for  Soviet  S-5  57mm  Rocket  */ 


/*  hydra  maximum  range  for  _M151  [actual  9000  m]  */ 
/*  hydra  maximum  range  for  M261  */ 

/*  hydra  maximum  range  for  M255  */ 


3.53.10.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.53.10.2.1  Algorithm 

HYDRA_MAX_RANGE_M151  is  used  to  bound  the  limit  of  the  range  for  the 
individual  rocket  when  the  rocket  type  is  HE  by  a  call  to  the  CSU 

missile_hydra_set_pylon_articulation. 


case  ROCKET_HE:  I*  type  101b  WARHEAD  V 

if(  range  >  HYDRA_MAX_RANGE_M151  ) 
range  =  HYDRA_MAX_RANGE_M151; 
ball_range  =  range  /  speedjactor; 
missile_utiLballistics_calc_traj(  ball_table,  table_size, 
ball_range,  0.0, 0.0, 
time,  se_angle ); 

*'lead_angle  =  atan(  (rkt_hydra_char[  0]  -  pylon_x)  /  range  ), 
“^time  =  -5;  I*  Does  not  have  a  timed  fuze  *! 
break; 


r 

HYDRA_MAX_RANGE_M151  is  assigned  to  the  maximum  range  variable 
for  the  individual  rocket  when  the  rocket  type  is  HE  by  a  call  to  the  CSU 
missile_hydra_fire. 


case  ROCKET_HE:  /  *  High  Explosive  V 

bmptr->max_range  =  HYDRA_MAX_RANGE_M151; 
rkt->sub_mun_type  =  SUB_MUN_NONE; 
rkt->sub_ammo_type  =  0; 
fuze  =  munition_US_M433; 
break; 


See  APPENDIX  M  for  a  complete  source  code  listing. 

3.53.11  HYDRA_MAX_RANGE_M261 

HYDRA_MAX_RANGE_M261  is  a  constant  defining  the  hydra  maximum 
range  for  the  M261. 

3.53.11.1  Initialization 

HYDRA_MAX_RANGE_M261  is  initialized  during  execution  of  the  CSU 
missile_hydra_init,  called  by  CSU  hydrajnit.  See  TABLE  5.1.53.  -  Hydra 
Rocket  Characteristics  Data  Array  for  a  summary  of  the  constant. 
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#define  HYDRA_MAX_RANGE_M261  rkt_hydra_char[10] 


The  following  declaration  sets  the  default  values. 


static  REAL  rkt_hydra_char[12]  = 

{ 

M151_BURST_SPREAD,  /*  twin  bursts  are  3  m  apart  *! 
M261_BURST_HEIGHT,  /*  release  subnaunitions  180  ft  */ 
M261_BURST_RANGE,  /*  0  m  in  front  of  target  (49  ?)  *! 
M261_BURST_SPREAD,  /*  twin  bursts  are  13  m  apart  *! 
M255_BURST_RANGE,  I*  release  darts  150  m  front  of  tgt  * ! 
M255_BURST_SPREAD,  I*  twin  bursts  are  35  m  apart  */ 
FLECH_60_MAX_RANGE,  I*  darts  fly  total  of  750  m  V 
50.0,  /*  hydra  minimum  range  *! 

5000.0,  I*  hydra  maximum  range  for  Soviet  S-5  57mm  Rocket  *! 

7000.0,  I*  hydra  maximum  range  for  _M151  [actual  9000  m]  * ! 

7000.0,  I*  hydra  maximum  range  for  M261  * ! 

3200.0  I*  hydra  maximum  range  for  M255  *! 

}; 


3.53.11.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.53.11.2.1  Algorithm 

HYDRA_MAX_RANGE_M261  is  used  to  bound  the  limit  of  the  range  for  the 
individual  rocket  when  the  rocket  type  is  MPSM  by  a  call  to  the  CSU 
missile_hydra_set_pylon_articulation. 

case  ROCKET_MPSM;  /  type  MPSM  V 

if(  range  >  HYDRA_MAX_RANGE_M261  ) 
range  =  HYDRA_MAX_RANGE_M261; 
ball_range  =  range  /  speed_factor; 
missile_util_ballistics_calc_traj(  ball_table,  table_size, 
ball_range,  0.0,  rkt_hydra_char[  1], 
time,  se_angle ); 

’^lead_angle  =  atan(  (rkt_hydra_char[  3]  -  pylon_x)  /  range  ); 
break; 
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HYDRA_MAX_RANGE_M261  is  assigned  to  the  maximuna  range  variable 
for  the  individual  rocket  when  the  rocket  type  is  MPSM  by  a  call  to  the  CSU 
missile_hydra_fire. 


case  ROCKET_MPSM:  I*  Multi-Purpose  Sub-Munition  */ 

bmptr->max_range  =  HYDRA_MAX_RANGE_M261; 
rkt->sub_mun_type  =  SUB_MUN_IMPACT; 
rkt->sub_ammo_type  =  munition_US_M73; 
rkt->sub_munition.impact.ainmo  =  munition_US_M73; 
rkt->sub_munition.impact.fuze  =  munition_US_M433; 
rkt->sub_munition.impact.quantity  =  m73_per_in261_burst; 
rkt->sub_munition.impact.height  =  rkt_hydra_char[  1]; 
fuze  =  inunition_US_M439; 
break; 


See  APPENDIX  M  for  a  complete  source  code  listing. 

3.53,12  HYDRA_MAX_RANGE_M255 

HYDRA_MAX_RANGE_M255  is  a  constant  defining  the  hydra  maximum 
range  for  the  M255. 

3.53.12.1  Initialization 

HYDRA_MAX_RANGE_M255  is  initialized  during  execution  of  the  CSU 
missile_hydra_init,  called  by  CSU  hydra_init.  See  TABLE  5.1.53.  -  Hydra 
Rocket  Characteristics  Data  Array  for  a  summary  of  the  constant. 


#define  HYDRA_MAX_RANGE_M255  rkt_hydra_char[ll] 
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The  following  declaration  sets  the  default  values. 


static  REAL  rkt_hydra_char[12]  = 


{ 

Ml  5 1  _BURST_SPRE  AD, 
M261_BURST_HEIGHT, 
M261_BURST_RANGE, 
M26 1  _BURST_SPRE  AD, 
M255_BURST_RANGE, 
M255_BURST_SPREAD, 
FLECH_60_MAX_RANGE, 
50.0, 

5000.0, 

7000.0, 

7000.0, 

3200.0 
}; 


I*  twin  bursts  are  3  m  apart  *! 

I*  release  submunitions  180  ft 
/*  0  m  in  front  of  target  (49  ?)  */ 

/*  twin  bursts  are  13  m  apart  */ 

/*  release  darts  150  m  front  of  tgt  */ 

■/*  twin  bursts  are  35  m  apart  */ 

/*  darts  fly  total  of  750  m  */ 

/*  hydra  minimum  range  */ 

/*  hydra  maximum  range  for  Soviet  S-5  57mm  Rocket  */ 
/*  hydra  maximum  range  for  _M151  [actual  9000  m]  */ 

/*  hydra  maximum  range  for  M261  */ 

/*  hydra  maximum  range  for  M255  */ 


3.53.12.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 


3.53.12.2.1  Algorithm 

HYDRA_MAX_RANGE_M255  is  used  to  bound  the  limit  of  the  range  for  the 
individual  rocket  when  the  rocket  type  is  FLECHETTE  by  a  call  to  the  CSU 
missile_hydra_set_pylon_articulation. 


case  ROCKET_FLECHETTE:  /*  type  FLECHETTE  V 

if(  range  >  HYDRA_MAX_RANGE_M255  ) 
range  =  HYDRA_MAX_RANGE_M255; 
ball_range  =  range  /  speed_factor; 
missile_util_ballistics_calc_traj(  ball_table,  table_size, 
ball_range,  rkt_hydra_char[  4],  0.0, 
time,  se_angle ); 

Tead_angle  =  atan((rkt_hydra_char[  5]  -  pylon_x)  / 

(range  -  rkt_hydra_char[  4])); 

break; 


HYDRA_MAX_RANGE_M255  is  assigned  to  the  maximum  range  variable 
for  the  individual  rocket  when  the  rocket  type  is  FLECHETTE  by  a  call  to  the 
CSU  missile_hydra_fire. 
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case  ROCKET_FLECHETTE:  I*  Flechette  discharging  warhead  *! 

bmptr->max_range  =  HYDRA_MAX_RANGE_M255; 
rkt->sub_mun_type  =  SUB_MUN_CANISTER; 
rkt->sub_ammo_type  =  n\unition_US_Flechette_60; 
rkt->sub_munition.dart.ammo  =  munition_US_Flechette_60; 
rkt->sub_munition.dart.fuze  =  0; 
fuze  =  munition_US_M439; 
break; 


See  APPENDIX  M  for  a  complete  source  code  listing. 

3.54  Sub_m73_char 

The  sub_m73_char  array  consists  of  characteristics  and  parameters  describing 
a  M73  submunition  flyout. 

3.54.1  Sub_m73_char[  0] 

Sub_m73_char[  0]  is  a  constant  defining  the  downward  acceleration  of  gravity 
as  75%  of  gravity,  per  tick  squared  (75%  (9.8m /sec**2)/ 225  ticks**2). 

3.54.1.1  Initialization 

The  sub_m73_char[0]  constant  is  initialized  during  execution  of  the  CSU 
missile_m73_init,  called  by  CSU  missile_hydra_fly_rockets.  See  TABLE 
5.1.54.  -  Submunitions  M73  Characteristics  Data  Array  for  a  summary  of  the 
array  data. 

The  following  declaration  is  for  the  default  values. 


static  REAL  sub_m73_char[3]  = 

{ 

0.03266667,  I*  75%  of  gravity  -  75%  9.8m/sec^'^2/225  ticks^'^2V 

M73_FOOT_ANGLE_X,  I*  bomblettes  fall  w/  +/-  8.8  deg  angular  displ 

V 

M73_FOOT_ANGLE_Y  /*  bomblettes  fall  w/  +/- 12.35  deg  angular  displ  * ! 

}; 


3.54.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.54.1.2.1  Algorithm 

Sub_m73_char[0]  is  used  to  compute  the  impact  timer  for  the  for  the  M73  by  a 
call  to  the  CSU  missile_m73_drop. 


impact  =  &(sub_mun->impact); 
if(  impact->timer  ==  0  ) 

{ 

if(  missile_util_comm_check_sub_mun(  bmptr, 

MSL_TYPE_BALLISTIC, 
sub_mun,  SUB_MUN_IMPACT  )) 

{ 

if(  impact->distance  >  0.0  ) 
impact->timer  =  (int) 

((8  *  scaled_rand())  +  1.0  + 

(sqrt((1.9  *  impact->distance)  /  sub_m73_char[0]))); 

else 

impact->  timer  =  -1; 

«  } 
else 
{ 

impact_pt[X]  =  bmptr->location[X]; 
impact_pt[Y]  =  bmptr->location[Y]  - 10; 
if(  traj_up ) 

impact_pt[Z]  =  bmptr->location[Z]  +  impact->distance; 
else 

impact_pt[Z]  =  10; 
traj_up  =  ( !  traj_up  ); 

missile_util_comm_release_sub_munition(  bmptr, 

MSL_TYPE_BALLISTIC, 
sub_mun,  SUB_MUN_IMPACT, 
impact_pt,  zero_velocity  ); 

} 

returnf  FALSE  ); 

} 

else 

{ 

if(  bmptr->time  <  impact->timer  )  /*  wait  until  sub_mun's  */ 

{  hit  the  ground....  */ 

bmptr->time  +=  1;  /*  incr  time  counter  */ 

returnf  FALSE ); 

} 

else 

{ 


/*  ie.  time  ==  timer  */ 
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if(  impact->  timer  >  0  ) 

^  missile_m73_getjmpact(  bmptr->location,  impact_pt, 
bmptr->launcher_C_world, 
impact->distance ); 

missile_util_comm_release_sub_munition 

( bmptr,  MSL_TYPE_BALLISTIC,  sub_mun, 
SUB_MUN_IMPACT,  impact_pt,  zero_velocity ); 

} 

I*  reset  time  counter  *! 
bmptr->time  =  0; 
returnf  TRUE ); 

} 


See  APPENDIX  O  for  a  complete  source  code  listing. 


3.54.2  M73_FOOT_ANGLE_X 

r 

M73  FOOT  ANGLE_X  is  a  constant  defining  the  dispersion  angle  on  the  x- 
axis  of  bomblettes  as  they  fall,  especially,  falling  with  +/-  8.8  degrees  angular 
displacement  along  the  x-axis. 


3.54.2.1  Initialization 

M73  FOOT_ANGLE_X  is  initialized  during  execution  of  ^he  CSU 
missile_m73_iiut,  called  by  CSU  missile_hydraJly_rockets.  See  TABLE 
5.1.54.  -  Submunitions  M73  Characteristics  Data  Array  for  a  summary  ot  the 
constant.  M73_FOOT_ANGLE_X  is  also  known  as  sub_m73_char[2]. 


The  following  declaration  is  for  the  default  values. 


static  REAL  sub_m73_char[3]  = 

0.03266667,  /*  75%  of  gravity  -  75%  9.8m/ sec'^^2/225  ticks^'^2V 

M73  FOOT_ANGLE_X,  /"^bomblettes  fall  w/  +/-  8.8  deg  angular  displ 

^  / 

M73_FOOT_ANGLE_Y  I*  bomblettes  fall  w/  +/- 12.35  deg  angular  displ  *! 

}; 


3.54.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.54.2.2.1  Algorithm 

Sub_m73_char[2]  is  used  to  compute  the  detonation  point  in  CSU 
missile_m73_get_impact. 


X  =  height  *  sin(deg_to_rad(  sub_m73_char[l]  *  (0.50  -  scaled_r and ()))); 
y  =  height  sin(deg_to_rad(  sub_m73_char[2]  *  (0.50  -  scaled_rand()))); 
detonation[X]  =  x  mCw[0][0]  -  y  mCw[0][l]; 
detonation[Y]  =  y  mCw[0][0]  +  x  mCw[0][l]; 
detonation[Z]  =  -  height; 


See  APPENDIX  O  for  a  complete  source  code  listing. 

3.54.3  M73_FOOT_ANGLE_Y 

M73  FOOT_ANGLE_Y  is  a  constant  defining  the  dispersion  angle  on  the  y- 
axis  of  bomblettes  as  they  fall,  especially,  falling  with  +/- 12.35  degrees  angular 
displacement  along  the  y-axis. 

3.54.3.1  Initialization 

M73_FOOT_ANGLE_Y  is  initialized  during  execution  of  the  CSU 
missile_m73_init,  called  by  CSU  missile_hydra_fly_rockets.  See  TABLE 
5.1.54.  -  Submunitions  M73  Characteristics  Data  Array  for  a  summary  of  the 
constant.  M73_FOOT_ANGLE_Y  is  also  known  as  sub_m73_char[3]. 

The  following  declaration  is  for  the  default  values. 


static  REAL  sub_m73_char[3]  = 

0.03266667,  757o  of  gravity  -  75%  *9.8m/sec^^2/225  ticks^^2*/ 

M73_FOOT_ANGLE_X,  /*  bomblettes  fall  w/  +/-  8.8  deg  angular  displ 

*/ 

M73_FOOT_ANGLE_Y  /*  bomblettes  fall  w/  +/- 12.35  deg  angular  displ  */ 

}; 


3.54.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 
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3.54.3.2.1  Algorithm 

Sub_m73_char[3]  is  used  to  compute  the  detonation  point  in  CSU 
missile_m73_get_impact. 


X  =  height  *  sin(deg_to_rad(  sub_m73_char[l]  *  (0.50  -  scaled_rand()))); 
y  =  height  *  sin(deg_to_rad(  sub_m73_char[2]  *  (0.50  -  scaled_rand()))); 
detonation[X]  =  x  *  mCw[0][0]  -  y  *  mCw[0][l]; 
detonation[Y]  =  y*  mCw[0][0]  +  x  *  mCw[0][l]; 
detonation [Z]  =  -  height; 


See  APPENDIX  O  for  a  complete  source  code  listing. 

3.55  Sub_flech_char 

The  sub_flech_char  array  consists  of  characteristics  and  parameters  describing 
M73  bomblettes  falling. 

3.55.1  INVEST_DIST_SQ 

The  INVEST_DIST_SQ  is  a  constant  defining  the  area  at  a  maximum  speed 
of  less  than  100  m/sec. 

3.55.1.1  Initialization 

The  INVEST_DIST_SQ  is  initialized  during  execution  of  the  CSU 
missile_flechette_init,  called  by  CSU  missile_hydra_fly_rockets.  See  TABLE 
5.1.55.  -  Submunitions  Flechette  Characteristics  Data  Array  for  a  summary  of 
the  constant. 


#define  INVEST_DIST_SQ 


sub_flech_char[0] 
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The  following  declaration  is  for  the  default  values. 


static  REAL  sub_flech_char[3]  = 

{ 

10000.0,  /*  (100  m)'^2  ::  max  speed  <  100  */ 

306.25,  /*  (17.5  m)^2  ::  flechettes  fly 

in  a  cylinder  with  a  radius 
of  17.5  m  and  length  of  750  in  */ 
FLECH_60_MAX_RANGE  /*  darts  fly  total  of  750m  */ 

}; 


3.55.1.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.55.1.2.1  Algorithm 

INVEST_DIST_SQ  is  used  to  compute  detonation  of  the  proximity  fuze  by  a 
call  in  the  CSU  missile_flechette_fly. 


PROX_FUZE  V 

if(  missile_fuze_all_prox(.  bmptr, 

MSL_TYPE_BALLISTIC,PROX_FUZE_ON_ALL_VEH, 
&(null_VehicleID),  &(dart->pptr), 
vehjist,  INVEST_DIST_SQ,  FUZE_DIST_SQ  ) ) 
do 
{ 

/*  DETONATION  ?  */ 

if(  missile_util_comm_check_sub_mun(  bmptr, 
MSL_TYPE_BALLISTIC, 
sub_mun,  SUB_MUN_CANISTER  )) 
missile_util_comm_release_sub_munition(  bmp  tr , 
MSL_TYPE_BALLISTIC, 
sub_mun, 

SUB_MLfN_CANISTER, 
zero_vector, 
velocity ); 

}  while(  dart->pptr  !=  NULL  && 

missile_fuze_detonate_prox(  bmptr,  MSL_TYPE_BALLISTIC, 
&(dart->pptr),  FUZE_DIST_SQ,  0 )); 


See  APPENDIX  P  for  a  complete  source  code  listing. 
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3.55.2  FUZE_DIST_SQ 

FUZE_DIST_SQ  is  a  constant  defining  the  square  of  the  radius  of  the  cylinder 
describing  the  flechettes  fly  in  a  cylinder  with  a  radius  of  17.5  meters  and  a 
length  of  750  meters 

3.55.2.1  Initialization 

The  FUZE_DIST_SQ  is  initialized  during  execution  of  the  CSU 
missilejlechettejnit,  called  by  CSU  missile_hydra_fly_rockets.  See  TABLE 
5.1.55.  -  Submunitions  Flechette  Characteristics  Data  Array  for  a  summary  of 
the  constant. 


#define  FUZE_DIST_SQ  sub_flech_char[l] 


The  following  declaration  is  for  the  default  values. 


static  REAL  sub_flech_char[3]  = 

{ 

10000.0,  I*  (100  m)^2  max  speed  <  100  V 
306.25,  /*  (175  m)^2::  flechettes  fly 

in  a  cylinder  with  a  radius 
of  17.5  m  and  length  of  750  m 

FLECH_60_MAX_RANGE  I*  darts  fly  total  of  750m  *! 

}; 


3.55.2.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.55.2.2.1  Algorithm 

FUZE_DIST_SQ  is  used  to  compute  detonation  of  the  proximity  fuze  by  a  call 
in  the  CSU  missile_flechette_fly. 
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PROX_FUZE  V 

if(  missile_fuze_all_prox(  bmptr, 

MSL_TYPE_BALLISTIC,PROX_FUZE_ON_ALL_VEH, 
&(null_VehicleID),  &(dart->pptr), 
vehjist,  INVEST_DIST_SQ,  FUZE_DIST_SQ  ) ) 
do 
{ 

I*  DETONATION  ?  V 

if(  missile_util_comm_check_sub_mun(  bmptr, 
MSL_TYPE_BALLISTIC, 
sub_mun,  SUB_MUN_CANISTER  )) 
inissile_util_comm_release_sub_munition(  bmptr, 
MSL_TYPE_BALLISTIC, 
sub_mun, 

SUB_MUN_CANISTER, 
zero_vector, 
velocity ); 

}  while!  dart->pptr  !=  NULL  && 

'  missile_fuze_detonate_prox(  bmptr,  MSL_TYPE_BALLISTIC, 

&(dart->pptr),  FUZE_DIST_SQ,  0 )); 


See  APPENDIX  P  for  a  complete  source  code  listing. 

3.55.3  FLECH_60_MAX_RANGE 

FLECH_60_MAX_RANGE  is  a  constant  defining  the  total  distance  the  darts 
fly  in  meters  after  the  proximity  fuze  detonates.  At  the  maximum  range,  the 
flechette  rounds  have  lost  the  momentum  and  fall  to  the  ground.  This 
constant  is  also  known  as  sub_flech_char[2]. 

3.55.3.1  Initialization 

The  constant  FLECH_60_MAX_RANGE  is  initialized  during  execution  of  the 
CSU  missilejlechettejnit,  called  by  CSU  missile_hydra_fly_rockets.  See 
TABLE  5.1.55.  -  Submunitions  Flechette  Characteristics  Data  Array  for  a 
summary  of  the  constant. 
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The  following  declaration  is  for  the  default  values. 


static  REAL  sub_flech_char[3]  = 

{ 

10000.0,  I*  (100  m)^2  ::  max  speed  <  100  *! 

306.25,  1^  (17.5  m)^2  ;;  flechettes  fly 

in  a  cylinder  with  a  radius 
of  17.5  m  and  length  of  750  m  * ! 
FLECH_60_MAX_RANGE  I*  darts  fly  total  of  750m  *! 

}; 


3.55.3.2  Usage 

During  real-time  execution,  this  constant  is  not  recomputed. 

3.55.3.2.1  Algorithm 

F1^ECH_60_MAX_RANGE  is  used  to  compute  the  termination  of  the  flight 
for  the  canister  and  darts. 


dart->distance  +=  bmptr->speed; 
if(  dart->distance  >=  sub_flech_char[2] ) 
return(  FALSE ); 


See  APPENDDC  P  for  a  complete  source  code  listing. 

3.56  Flechette_speed_coef 

The  flechette_speed_coef  array  consists  of  the  coefficients  for  a  polynomial 
equation  defining  the  flechette  flyout  speed  with  respect  to  time  in  the  form 
using  the  Newton-Raphson  method. 

3.56.1  Initialization 

The  flechette_speed_coef  array  is  initialized  during  execution  of  the  CSU 
missilejlechettejnit,  called  by  CSU  missiie_hydra_fly_rockets.  See  TABLE 
5.1.56.  -  Flechette  Speed  Data  Array  for  a  summary  of  the  array  data. 

The  array  has  a  maximum  size  of  5  elements. 


-367- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


3.56.2  Usage 

During  real-time  execution,  this  array  is  not  recomputed. 
FLECHETTE_SPEED_DEG  determines  the  number  of  elements  of  the  array  to 
be  used  in  the  polynomial  evaluation. 

3.56.2.1  Algorithm 

The  flechette_speed_coef  array  is  used  to  compute  the  flechette  speed  during 
free  fall  using  the  CSU  missile_util_eval_poly,  and  called  by  the  CSU 
missilejlechettejly.  The  CSU  missile_util_eval_poly  uses  the  Newton- 
Raphson  method  to  evaluate  the  polynomial  with  inputs  of  degree  of 
polynomial,  coefficient  array,  and  distance. 


bmptr->speed  = 

missile_util_eval_poly(  FLECHETTE_SPEED_DEG, 

flechette_speed_coef, 
dart->distance  )  +  dart->init_speed; 


See  APPENDIX  P  for  a  complete  source  code  listing. 
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4.  Error  messages. 

The  error  messages  are  located  in  the  source  code.  See  the 
appropriate  Appendix  for  the  error  messages. 
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5.  CSCI  data. 

This  section  describes  only  those  global  data  elements  modified  or 
added  within  the  CSCI  under  this  delivery  order.  For  ease  in 
readability  and  maintenance,  the  information  is  provided  in  tables. 

5.1.  Data  elements  internal  to  the  CSCI. 

a.  For  data  elements  internal  to  the  CSCI,  the 
following  tables  describe  the  data  arrays  and  the 
data. 


t 
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TABLE  5.1.1. -AERODYNAMICS  DATA  ARRAY 

[Conlinuedl 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.1.  -  AERODYNAMICS  DATA  ARRAY 

(Continued] 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.2.  -  AERODYNAMICS  INITIALIZATION  DATA  ARRAY 


Reference  #W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.3.  -  AERODYNAMICS  SIMPLE  DATA  ARRAY 


Reference  #W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.18.  -  MAVERICK  MISSILE  COAST  SPEED  COEFFICIENT  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 


-394- 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.20.  -  STINGER  MISSILE  POLYNOMIAL  DEGREE  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.23  -  TOW  MISSILE  CHARACTERISTICS  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.25.  -  TOW  MISSILE  BURN  SPEED  COEFFICIENT  DATA  ARRAY 


Reference  #W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.27.  -  TOW  MISSILE  BURN  TURN  COEFFICIENT  DATA  STRUCTURE 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 


TABLE  5.1.28.  -  TOW  MISSILE  COAST  TURN  COEFFICIENT  DATA  STRUCTURE 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.29  -  AD  AT  MISSILE  CHARACTERISTICS  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.31.  -  ADAT  MISSILE  BURN  SPEED  COEFFICIENT  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 


-402- 


TABLE  5.1.32.  -  ADAT  MISSILE  COAST  SPEED  COEFFICIENT  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
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TABLE  5.1.33.  -  ADAT  MISSILE  BURN  TURN  COEFFICIENT  DATA  AR 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.34.  -  ADAT  MISSILE  COAST  TURN  COEFFICIENT  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.35.  -  ADAT  MISSILE  TEMPORAL  DIAS  COEFFICIENT  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.36  -  ATGM  MISSILE  CHARACTERISTICS  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.38.  -  ATGM  MISSILE  BURN  SPEED  COEFFICIENT  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.40.  -  ATGM  MISSILE  BURN  TURN  COEFFICIENT  DATA  STRUCTURE 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.41.  -  ATGM  MISSILE  COAST  TURN  COEFFICIENT  DATA  STRUCTURE 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 


TABLE  5.1.42  -  KEM  MISSILE  CHARACTERISTICS  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.44.  -  KEM  MISSILE  BURN  SPEED  COEFFICIENT  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.45.  -  KEM  MISSILE  COAST  SPEED  COEFFICIENT  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.46.  -  KEM  MISSILE  BURN  TURN  COEFFICIENT  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.47.  -  KEM  MISSILE  COAST  TURN  COEFFICIENT  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.48.  -  NLOS  MISSILE  CHARACTERISTICS  DATA  ARRAY 


Reference  #W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.49.  -  NLOS  MISSILE  POLYNOMIAL  DEGREE  DATA  ARRAY 
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Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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TABLE  5.1.52  -  HYDRA  ROCKET  CONFIGURATION  DATA  ARRAY 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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Reference  #  W003092;  31  March  1993 
Volume  1  of  2;  Rev.  0.0 
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TABLE  5.1.55.  -  SUBMUNITIONS  FLECHETTE  CHARACTERISTICS  DATA 


Reference  #  W003092;  31  March  1993 
Volume  1  of  2;  Rev.  0.0 
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Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


6.  Notes. 
NONE. 
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Appendix  A  -  RWA  AirNet  Call  Tree  Structure. 

The  following  appendix  contains  information  for  convenience  in 
document  maintenance  and  understanding  of  the  overall  CSCI 
architecture.  This  call  tree  is  not  all  inclusive,  i.e.,  it  only  contains  the 
calls  from  the  top-level  down  to  the  CSU  of  interest  in  this 
document.  Other  CSCs  and  CSUs  have  been  included  in  the  Call 
Tree  for  clarity  and  reference. 
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RWA  AIRNET  CALL  TREE  STRUCTURE 


Reference  #  W003092;  31  March  1993 
Volume  1  of  3;  Rev.  0.0 
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Appendix  B  -  Source  code  listing  for  rwa_aerodyn.c. 

The  following  appendix  contains  the  source  code  listing  for 
rwa_aerodyn.c  for  convenience  in  document  maintenance  and 
understanding  of  the  CSU. 
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APPENDIX  B  -  rwa_aerodyn.c 

/*  $Header:  /a3 /adst-cin/RWA/AIRNET/simnet/vehicle/rwa/src/RCS/rwa_aerodYn . c , v  1.6 

1993/01/28  23:33:00  cm-adst  Exp  $  */ 

/* 

*  $Log:  rwa_aerodyn . c , V  $ 

*  Revision  1.6  1993/01/28  23:33:00  cm-adst 

*  P.  DesMeueles's  changes  for  spcr  31 

* 

*  Revision  1.5  1992/12/21  22:14:41  cm-adst 

*  R.  Branson's  flight  changes.  These  changes  will  become 

*  BDS-D  1.1.1.  This  change  was  turned  over  by  C.  Swanson. 

* 

*  Revision  1.1  1992/10/07  19:00:23  cm-adst 

*  Initial  Version 


static  char  RCS_ID[]  =  "$Header:  /a3/adst-  23 -33 -00 

cm/RWA/AIRNET/simnet/vehicle/rwa/src/RCS/rwa_aerodyn.c,v  1.6  1993/01/28  23.33.00 

cm-adst  Exp  $“; 


*1  Revisions: 

ic 


SP/CR  Number 


*  Version  Date  Author  Title  SP/CR  Numoer 

★  _ 

it 

*  1.2  10/09/92  R.  Branson  Data  File  Initiali- 

*  '  zation 

*  1.3  10/16/92  R.  Branson  Data  filenames  changed 

*  ‘  to  eight  charachters 

*  1.4  10/30/92  R.  Branson  Added  pathname  to  data 

*  directory 

*  1.5  01/19/93  P.Desmeules  Increased  the  size  of  the  31 

*  fgets  to  make  sure  the 

*  whole  line  is  read  in. 

*  15  03/04/93  P.Desmeules  Fix  the  value  of  85 

*  ■  hover_aug_pitch_reset_value 

!****************************************************************************/ 

/***************************************************************************** 

* 

*  SP/CR  No.  Description  of  Modification 


Hard  coded  defines  changed  to  array  elements. 
Aerodyn  data  array  added. 

Aerodyn  initialization  data  array  added. 

Aerodyn  stealth  data  array  added. 

Aerodyn  simple  data  array  added. 

Added  file  read  for  aerodyn  data,  aerodyn  initiali¬ 
zation  data,  aerodyn  stealth  data,  and  aerodyn 
simple  data  to  the  "aerodyn_init"  function. 

Added  “ /simnet/data/ "  to  each  data  file  pathname. 
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•k 


*  FILE; 

*  AUTHOR: 

*  MAINTAINER: 

*  HISTORY: 

* 

★ 

* 


rwa_aerodyn . c 

James  Chung  * 

James  Chung 

4/19/89  james:  Creation  * 

8/02/90  carol:  added  simplified  aero  dynamics* 

★ 

★ 


*  Copyright  (c)  1989  BBN  Systems  and  Technologies  Corporation  * 

*  All  rights  reserved.  * 


*  Interim  aerodynamics  model  for  a  generic  rotary  wing  aircraft* 

*  with  flight  characteristics  similar  to  that  of  a  McDonnell  * 

*  Douglas  AH-64  Apache  attack  helicopter.  * 

* 


# include 
# include 
# include 
# include 
# include 
#include 
# include 
# include 


"stdio .h" 
"simstdio.h" 

" math .h“ 
■'sim_dfns  .h" 
“sim_types .h" 
"sim_macros .h" 
"libmatrix.h" 

" libmath.h" 


# include 
i include 
# include 
# include 
tinclude 
# include 
# include 
# include 
# include 
# include 
# include 
# include 


“  rwa_engine .h" 
"vehicle .h" 

" aero_param . h " 
“std_atm.h" 

” ground. h" 

" rwa_ground . h “ 
“parameters .h" 

" rwa_kinemat . h " 
" 1 ibmun . h " 

" libhull .h“ 

“ libkin .h" 

" rwa_aerodyn . h " 


/* 

*  Debug  macro 
*/ 

#ifdef  FILEDBG 
tdefine  P{a)  a 

#else 

#define  P(a) 

#endif 

# define  MOMENT_OF_INERTIA_X 
idefine  MOMENT_OF_INERTIA_Y 
#define  MOMENT_OF_INERTIA_Z 


aero_data[  0] 
aero_data[  1] 
aero_data [  2 ] 


-B-3- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 

APPENDIX  B  -  rwa_aerodyn.c 


Sdefine  AIRFRAME_MASS 
#define  ORDINANCE_MASS 
#define  GRAV_CONSTANT 
Sdefine  CG_AC_X 
# define  CG_AC_Y 
# define  CG_AC_Z 


aero_data [ 

3] 

aero_data [ 

4] 

aero_data [ 

5] 

aero_data [ 

6] 

aero_data [ 

7] 

aero_data [ 

8] 

#define  VIRTUAL_WING_AREA 
#define  VIRTUAL_WING_COP_AC_X 
#define  VIRTUAL_WING_COP_AC_Y  - 
#define  VIRTUAL_WING_COP_AC_Z 
#define  WING_LIFT_COEFFICIENT_FIT_3 
#define  WING_LIFT_COEFFICIENT_FIT_2 
# de  f i ne  WING_L I FT_COEFF IC I ENT_F IT_1 
Sdefine  WING_LIFT_COEFFICIENT_FIT_0 
#define  WING_STALL_AOA 


aero_data [  9 ] 
aero_data [ 10 ] 
aero_data [ 11 ] 
aero_data [ 12 ] 
aero_data [ 13 ] 
aero_data [ 14 ] 
aero_data [ 15 ] 
aero_data [ 16 ] 
(deg_to_rad (aero_data [ 17 ] ) 


#define  VSTAB_AREA 

Sdefine  VSTAB_COP_AC_X 

# define  VSTAB_COP_AC_Y 

#define  VSTAB_COP_AC_Z 

#define  VSTAB_LIFT_COEFFICIENT_l 

# define  VSTAB_STALL_SSA 


aero_data [ 18 ] 
aero_data [ 19 ] 
aero_data [20 ] 
aero_data [21] 
aero_data [22 ] 

(deg_to_rad (aero_data [23 ] ) ) 


#define  MAIN_ROTOR_COP_AC_X 
idefine  MAIN_ROTOR_COP_AC_Y 
# define  MAIN_ROTOR_COP_AC_Z 
#define  MAIN_ROTOR_MAX_THRUST 
#define  MAIN_ROTOR_MAST_TILT  {deg_to. 

# define  MAIN_ROTOR_MAX_LOAD_TORQUE 
# define  MAIN_ROTOR_MAX_PITCH_MOMENT 
idefine  MAIN_ROTOR_MAX_ROLL_MOMENT 
idefine  MAIN_ROTOR_TORQUE_COUPLING_GAIN 
idefine  MAIN_ROTOR_GROUND_EFFECT_FACTOR 


aero_data[24] 
aero_data [25] 
aero_data [26] 
aero_data [27 ] 

.rad ( aero_data [28])) 
aero_data [29 ] 
aero_data [30  ] 
aero_data [31 ] 
aero_data [32 ] 
aero_data [33 ] 


idefine  TAIL_ROTOR_COP_AC_X 
idefine  TAIL_ROTOR_COP_AC_Y 
idefine  TAIL_ROTOR_COP_AC_Z 
idefine  TAIL_ROTOR_MAX_THRUST 
idefine  TAIL_ROTOR_MAX_LOAD_TORQUE 


aero_data [34 ] 
aero_data[35] 
aero_data [36] 
aero_data [37 ] 
aero_data [38 ] 


idefine  P_DRAG_COEFF_CONST 
idefine  P_DRAG_TAS_BREAK 
idefine  P_DRAG_COEFF_BREAK 
idefine  P_DRAG_TAS_MAX 
idefine  P_DRAG_COEFF_MAX 
idefine  TOTAL_WETTED_SURFACE_AREA 


aero_data[39] 
aero_data[40] 
aero_data[41] 
aero_data [42 ] 
aero_data [ 43 ] 
aero_data[44] 


idefine  ATT_DAMPING_MODE_SIMPLE  TRUE 
/********************************************* 


★ 


Hover  hold  changes : 


if  ATT_DAMPING_MODE_SIMPLE 

when  slow  moving  {  airspeed<10  knots  )  the  max  pitch  is  5  degrees 
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medium  {  10<=airspeed<30  )  pitch  is  10  degrees 

other  (  30<=airspeed  )  pitch  is  15  degrees 

when  airspeed  >=  10  knots  pitch  is  proportional  to  log (speed) 
otherwise  pitch  is  +/-  5  degrees 


Paul  J.  Metzger  11-1-89 


static  REAL  MAX_ATT_CTL_ANGLE; 

# define  MAX_ATT_CTL_ANGLE_STOP 
# define  MAX_ATT_DAMPING_F ACTOR 
#define  HOVER_SLOW_LIMIT 
#def ine  HOVER_AUG_PITCH_RESET_VALUE 
static  int  hover_hold_turned_on; 


aero_data [45] 
aero_data [46] 
aero_data [47] 
aero_data[48] 

/*  transition  mode,  TRUE  or  FALSE  */ 


#if  ATT_DAMPING_M0DE_SIMPLE 
# define  MAX_ATT_CTL_ANGLE_NORM 
#define  MAX_ATT_CTL_ANGLE_MED 
#define  MAX_ATT_CTL_ANGLE_SLOW 
#define  HOVER_MED_LIMIT 
#endif 


#define  ATT_CTL_PITCH_P_GAIN 
#define  ATT_CTL_PITCH_I_GAIN 
#define  ATT_CTL_ROLL_P_GAIN 
#define  ATT_CTL_ROLL_I_GAIN 


#define  LIFT_COEFF_VIRTUAL_WING 
#define  OSWALD_EFFIC_FACTOR 
{(define  INDUCED_DRAG_COEFF 


(deg_to_rad  (aero_data [49] ) ) 
{deg_to_rad  {aero_data [ 50 ] ) ) 

{deg_to_rad  {aero_data[51] ) ) 
aero_data [ 52 ] 


aero_data [ 53 ] 
aero_data [ 54 ] 
aero_data [ 55] 
aero_data[56] 

aero_data[57] 
aero_data[58] 
aero_data [ 59 ] 
aero_data [ 60 ] 
aero_data [61] 
aero_data [ 62 ] 
aero_data [ 63 ] 
aero_data [ 64 ] 
aero_data [65] 
aero_data [66] 

aero_data [ 67 ] 
aero_data[68] 
aero_data [ 69 ] 
aero_data[70] 
aero_data [71] 

aero_data [72 ] 
aero_data [73 ] 
aero_data [74] 


#define  HOVER_AUG_ROLL_P_GAIN 
#define  HOVER_AUG_ROLL_I_GAIN 
#define  HOVER_AUG_PITCH_P_GAIN 
#define  HOVER_AUG_P ITCH_I_GAIN 
# de f ine  HOVER_AUG_YAW_P_GAIN 
#define  HOVER_AUG_YAW_I_GAIN 
# define  HOVER_AUG_CLIMB_P_GAIN 
#define  HOVER_AUG_CLIMB_I_GAIN 
# de f ine  MAX_ST AB_AUG_P ITCH_ROLL_CONTROL 
# de f ine  MAX_STAB_AUG_YAW_CLIMB_CONTROL 

Sdefine  ROLL_RATE_DAMPING_GAIN 
#define  PITCH_RATE_DAMPING_GAIN 
#define  YAW_RATE_DAMPING_GAIN 
# define  VERTICAL_RATE_DAMPING_GAIN 
#de f ine  LATERAL_VELOC ITY_DAMP ING_GAIN 


/* 

*  SPCR  85  -  fix  the  value  of  HOVER_AUG_PITCH_RESET  (element  48)  from 

*  .44  to  .044 
*/ 

static  REAL  aero_data [ 100 ]  =  { 

50000.000,  50000.000,  50000.000,  4881.000,  1591.000, 
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9.8, 

0.0, 

1.0, 

-9.1, 

0.0, 

100000.0, 

-9.1, 

50.0, 

6.0, 

10.0, 

5.0, 

0.001, 

0.2, 

2000.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

}  ; 

static  REAL  aero_ 
0.0, 

0.0, 

0.0, 

0.0, 

}  ; 

static  REAL  aero_ 
500000.0, 
100.0, 
400000.0, 
0.0, 

)  ; 


0. 

0, 

0. 

0, 

-0. 

100, 

25  . 

0, 

0. 

0, 

0. 

0, 

0  . 

0, 

0  . 

0, 

0. 

0, 

30. 

0, 

3. 

0, 

0. 

0, 

0  . 

0, 

5. 

0, 

60. 

0, 

0. 

0, 

2  . 

0, 

123500. 

,0, 

2  . 

,5, 

76476. 

0, 

100000.0, 

0.5, 

0.4, 

0. 

0 

0. 

.0, 

8909. 

.1, 

1684. 

,8, 

0. 

.0, 

0. 

,02, 

100. 

.0, 

0. 

,06, 

50  . 

.0, 

4. 

.5, 

5. 

.15, 

0. 

.044, 

15. 

.0, 

6. 

.0, 

15, 

.46, 

2 , 

.5, 

0. 

.05 

'  t 

0 , 

.05, 

•  0, 

.1, 

0 , 

.001, 

0, 

.1, 

10, 

.0, 

5 

.0, 

1 

.0, 

0, 

.5, 

0 

.05, 

100000 

.0, 

100000 

.0, 

100000 

.0, 

1000 

.0, 

0 

.6, 

0 

.9, 

0 

.0, 

0 

.0, 

0 

.0, 

0 

.0, 

0 

.0, 

0 

.0, 

0 

.0, 

0 

.0, 

0 

.0, 

0.0, 

0.0, 

0.0, 

0. 

0 

0.0, 

0.0, 

0.0, 

0. 

,0 

0 

.0, 

0 

.0, 

0 

.0, 

0 

.0 

init[20]  =  { 
0.0, 

o 

o 

o 

o 

o 

o 

O 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

simple [20 ] 
0.5, 

=  { 

48.0, 

0.15, 

o 

o 

150000.0, 

1.5, 

0.7, 

0.03 

100.0, 

0.0, 

O 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

o 

static  REAL  aero_stealth [ 2 0 ] 
80.0,  30.0, 

5000.0,  25000.0, 

0.0,  0.0, 
0.0,  0.0, 


}  ; 


{ 

10.0,  10000000000.0,  10000000000.0, 

0.03,  0.0,  0.0, 

0.0,  0.0,  0.0, 

0.0,  0.0,  0.0 


static  int  hover_hold_state; 

static  REAL  MAIN_ROTOR_MAST_TILT_SIN; 
static  REAL  MAIN_ROTOR_MAST_TILT_COS; 

static  REAL  altitude; 
static  REAL  true_airspeed; 
static  REAL  last_airspeed  =  0; 
static  REAL  vertical_speed; 
static  REAL  roll; 
static  REAL  pitch; 
static  REAL  roll_rate; 
static  REAL  pitch_rate; 


/*  OFF  or  ON  */ 


/*  m  */ 

/*  m/sec  */ 

/*  m/sec  */ 

/*  m/sec  */ 

/*  rad  */ 

/*  rad  */ 

/*  rad/sec  */ 
/*  rad/sec  */ 
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static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

s'tatic 

static 

static 

static 


REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 

REAL 


/*  rad/sec  */ 


g_force ; 
last_g_force; 
yaw_rate ; 
pitch_damping; 
roll_damping; 
yaw_damping; 
ambient_temperature ; 
aiTibient_pressure  ; 
ambient_density ; 
dynainic_pressure; 
inain_rotor_thrust ; 
ta i l_rotor_thrus  t ; 
lift_virtual_wing; 
lif t_vstab; 

1 i f t_coe  f  f ic ient_virtual_wing ; 

lift_coefficient_vstab; 

total_drag; 

total_incompressible_drag_coef f icient ; 


/* 

/* 

/* 

/* 


deg  R  */ 

N  /  in"2  */ 
kg  /  m''3  */ 


N 


/  m 
/* 
/* 
/* 


*/ 

*/ 

*/ 

*/ 


gross_weight ; 
vehicle_mass ; 
angle_of_attack; 
side_sli p_ang 1 e ; 
main_rotor_load_torque; 
tail_rotor_load_torque; 


/ 

/* 

/* 

/* 

/* 

/* 


*/ 

*/ 


powertrain_percent_shaf t_speed; 


N 
kg 
rad  */ 
rad  */ 
N-m  */ 
N-m  */ 
/* 


0-1  */ 


static  REAL  cyclic_pitch;  /*  -1  to  1 

static  REAL  cyclic_roll;  /*  “1  to  1 

static  REAL  collective;  /*  0  to  1 

static  REAL  pedal;  /*  "1  to  1 

static  REAL  stab_aug_pitch; 

static  REAL  stab_aug_roll ; 

static  REAL  stab_aug_yaw; 

static  REAL  stab_aug_climb; 

static  REAL  stab_aug_pitch_integrator ; 

static  REAL  stab_aug_roll_integrator ; 

static  REAL  stab_aug_yaw_integrator ; 

static  REAL  stab_aug_climb_integrator ; 

static  REAL  hover_aug_pitch_angle ; 

static  REAL  hover_aug_roll_angle; 

static  REAL  hover_aug_pitch_integrator ; 

static  REAL  hover_aug_rol l_integrator ; 

static  REAL  attitude_control_roll_integrator ; 

static  REAL  attitude_control_pitch_integrator ; 

static  REAL  attitude_control_roll_command; 

static  REAL  attitude_control_pitch_cominand; 

static  REAL  controller_cyclic_pitch; 

static  REAL  controller_cyclic_roll ; 

static  REAL  controller_collective; 

static  REAL  controller_tail_rotor ; 


*/ 

*/ 

*/ 

*/ 


/*  Flight  controls  */ 
/*  Flight  controls  */ 


static  REAL  *angular_velocity_vector ;  /*  kinematic  state  vectors  / 

static  REAL  . *normalized_velocity_vector ; 
static  REAL  *velocity_vector ; 
static  REAL  *gravity_dir_vector ; 
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static  REAL  p_drag_fit_coef f [9] ; 


/*  parasite  drag  fit  coefficients  */ 


static 

static 

static 


REAL  oswald_eff iciency_factor; 
REAL  induced_drag_coeff icient; 
REAL  paras i te_drag_coe ff icient; 


static  VECTOR  loc_ac_main_rotor_cop ; 
static  VECTOR  loc_ac_tail_rotor_cop; 
static  VECTOR  loc_ac_virtual_wing_cop; 
static  VECTOR  loc_ac_vstab_cop ; 
static  VECTOR  loc_ac_cg; 

static  VECTOR  lif t_body_virtual_wing;  /*  body  [X  Y  Z]  */ 

static  VECTOR  lift_body_vstab; 

static  VECTOR  force_body_main_rotor ; 

static  VECTOR  force_body_tail_rotor ; 

static  VECTOR  force_body_damping ; 

static  VECTOR  drag_body; 

static  VECTOR  gravity_force_body ; 

static  VECTOR  force_ground_ef feet ; 

static  VECTOR  force_body;  /*  sum  of  all  forces  */ 

static  VECTOR  moment_body_virtual_wing;  /*  body  [X  Y  Z]  */ 

static  VECTOR  moment_body_vstab; 

static  VECTOR  moment_body_main_rotor ; 

static  VECTOR  moment_body_torque_coupling; 

static  VECTOR  moment_body_tail_rotor ; 

static  VECTOR  moment_body_cg ; 

static  VECTOR  moment_body_damping; 

static  VECTOR  moment_body ; 

static  VECTOR  virtual_wing_force ;  /*  velocity  [H  D  L]  */ 

static  VECTOR  vstab_force ; 
static  VECTOR  drag_force; 


static  T_MAT_PTR  velocity_to_body ;  /*  vel  ->  body  xform  */ 


static  T_MATRIX  inert ia_matrix  = 

{  {50000.0,  0,  0), 

{0,  50000.0,  0), 

{0,  0,  50000.0}}; 

int  funny_little_kludge  =  1;/*  default  is  logarithmic  for  complex  model  / 
static  int  aerodyn_debug  =  0; 

static  int  selected_model  =  COMPLEX_MODEL ;  /*  default:  James'  model  */ 

static  int  allow_takeof f  =  TRUE;  /*  allow  stealth  model  to  take  off  */ 

static  int  level_view  =  TRUE;  /*  unset  any  pitch  */ 

static  REAL  ground_height  =  2.8; 

void  aero_body_point_set_front_wheels {  distance_from_hull  ) 

REAL  distance_from_hull ; 

{ 

body _point [0] .position [Z]  =  distance_f rom_hull ; 


-B-8- 


Reference  #W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


APPENDIX  B  -  rwa_aerodyn.c 


body_point  [1]  .position  [Z]  =  distance_f  roin_hull  ; 

ground_height  =  (REAL) ( { (int) (-distance_from_hull  *  10))  /  10.0); 

printf{  "Front  Wheels  set  %1.41f  m.  under  Hull.Xn", 
distance_f rom_hull ) ; 


void  aero_body_point_set_rear_wheel (  distance_f rom_hull 
REAL  distance_from_hull ; 

{ 

body _po int  [2  ]  .position  [Z]  =  distance_froni_hull  ; 
printf{  "Rear  Wheel  set  %1.41f  m.  under  Hull.\n", 
distance_from_hull) ; 


} 


) 


REAL  aero_get_ground_height ( ) 

{ 

return {  ground_height  ) ; 

1 


void  aerodyn_init { ) 

{ 

I  int  i; 

/*  DEFAULT  DATA  FOR  rwa_aerodyn . c  READ  FROM  FILE  */ 

int  j  ; 

float  data_tmp; 

char  descript [80] ; 

FILE  *fp; 

P{printf ("$$$$  RWA  AERODYN  $$$$\n" ) ; ) ; 

fp  =  fopen(“/simnet/data/rwa_aero.d",“r''); 
if {fp==NULL) { 

fprintf {stderr,  "Cannot  open  /siinnet/data/rwa_aero.d\n" ) ; 
exit { ) ; 

} 

rewind ( fp) ; 

/*  Read  array  data  */ 

j=0; 

while  {fscanf  { fp, ''%f'‘ ,  &data_tinp)  !=  EOF)  { 
aero_data[j]  =  data_tinp; 
fgets {descript ,  80,  fp); 

P(printf {"aero_data(%3d)  is%11.3f  %s\n",  j,  aero_data [ j ] , 
descript) ; ) ; 

+  +  j  ; 

} 

fclose (fp) ; 

/*  END  DEFAULT  DATA  FOR  rwa_aerodyn . c  READ  FROM  FILE  */ 

/*  DEFAULT  INITIALIZATION  DATA  FOR  rwa_aerodyn . c  READ  FROM  FILE  */ 
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fp  =  fopen ( " /simnet/data/rw_ae_in .d" , "r" ) ; 
if(fp==NULL){ 

fprintf (stderr,  “Cannot  open  /siinnet/data/rw_ae_in .d\n“ ) ; 
exitO; 

) 

rewind { fp) ; 

/*  Read  array  data  */ 
j=0; 

while{fscanf (fp, "%f " ,  &data_tmp)  !=EOF}{ 
aero_init[j]  =  data_tmp; 
fgets (descript,  80,  fp) ; 

P(printf ( "aero_init(%3d)  is%11.3f  %s\n",  j,  aero_init [ j ] , 
descript ) ; ) ; 

++j  ; 

} 

fclose ( fp) ; 

/*  END  DEFAULT  INITIALIZATION  DATA  FOR  rwa_aerodyn . c  READ  FROM  FILE  */ 

$ 

/*  DEFAULT  SIMPLE  INITIALIZATION  DATA  FOR  rwa_aerodyn . c  READ  FROM  FILE  */ 
fp  =  fopen{"/siranet/data/rw_ae_sp.d”, “r") ; 
if (fp==NULL) { 

fprintf (stderr,  “Cannot  open  /sininet/data/rw_ae_sp.d\n" ) ; 
exit ( ) ; 

} 

rewind ( fp) ; 

/*  Read  array  data  */ 
j=0; 

while  (  fscanf  (  fp,  “%f” ,  £cdata_tmp)  !=  EOF)  { 
aero_simple [ j ]  =  data_tmp; 
fgets (descript ,  80,  fp) ; 

P (printf ( "aero_simple (%3d)  is%11.3f  %s\n“,  j,  aero_simple [ j ] , 
descript ) ; ) ; 

++ j  ; 

) 

fclose ( fp) ; 

/*  END  DEFAULT  SIMPLE  INITIALIZATION  DATA  FOR  rwa_aerodyn . c  READ  FROM  FILE*/ 

/*  DEFAULT  STEALTH  INITIALIZATION  DATA  FOR  rwa_aerodyn . c  READ  FROM  FILE  */ 
fp  =  fopen {“ /simnet/data/rw_ae_sl .d" , "r“ ) ; 
if (fp==NULL) { 

fprintf (stderr,  "Cannot  open  /simnet/data/rw_ae_sl .d\n“ ) ; 
exit ( ) ; 

} 

rewind (fp); 

/*  Read  array  data  */ 
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j=0; 

while  ( fscanf  (fp, &data_tmp)  !=  EOF)  { 
aero_stealth[ j ]  =  data_tmp; 
fgets {descript ,  80,  fp) ; 

P(printf  (''aero_stealth(%3d)  is%11.3f  %s\n",  j,  aero_stealth  [  j  ]  , 
descript) ; ) ; 

++j  ; 

} 

fclose ( fp) ; 

/*  END  DEFAULT  STEALTH  INITIALIZATION  DATA  FOR  rwa_aerodYn . c  READ  FROM  FILE*/ 
engine_init ( ) ; 

cyclic_pitch  =  aero_init[  0); 

cyclic_roll  =  aero_init[  1]; 

if  ( selected_model  !=  STEALTH_MODEL) 

collective  =  aero_init[  2]; 

else 

{ 

collective  =  0.5; 

(  allow_takeof f  =  TRUE; 

} 

pedal  =  aero_init [  3 ] ; 

stab_aug_pitch_integrator  =  aero_init [  4]; 

stab_aug_roll_integrator  =  aero_init[  5] ; 

stab_aug_yaw_integrator  =  aero_init[  6]; 

stab_aug_climb_integrator  =  aero_init[  7]; 

attitude_control_pitch_integrator  =  aero_init[  8]; 
attitude_control_roll_integrator  =  aero_init[  9]; 

hover_aug_pitch_integrator  =  aero_init [ 10 ] ; 

hover_aug_roll_integrator  =  aero_init[ll]; 

hover_aug_pitch_angle  =  aero_init [ 12 ] ; 

hover_aug_roll_angle  =  aero_init[13]; 

hover_hold_state  =  OFF; 
hover_hold_turned_on  =  FALSE; 

loc_ac_niain_rotor_cop [X]  =  MAIN_ROTOR_COP_AC_X; 
loc_ac_main_rotor_cop [ Y]  =  MAIN_ROTOR_COP_AC_Y ; 
loc_ac_main_rotor_cop[Z]  =  MAIN_ROTOR_COP_AC_Z; 

loc_ac_tail_rotor_cop [X]  =  TAIL_ROTOR_COP_AC_X; 
loc_ac_tail_rotor_cop [ Y]  =  TAIL_ROTOR_COP_AC_Y ; 
loc_ac_tail_rotor_cop [Z]  =  TAIL_ROTOR_COP_AC_Z ; 

loc_ac_virtual_wing_cop [X]  =  VIRTUAL_WING_COP_AC_X; 
loc_ac_virtual_wing_cop [Y]  =  VIRTUAL_WING_COP_AC_Y; 
loc_ac_virtual_wing_cop [Z]  =  VIRTUAL_WING_COP_AC_Z; 

loc_ac_vstab_cop[X]  =  VSTAB_COP_AC_X; 
loc_ac_vstab_cop[Y]  =  VSTAB_COP_AC_Y ; 
loc_ac_vstab_cop[Z]  =  VSTAB_COP_AC_Z ; 
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loc_ac_cg[X]  =  CG_AC_X; 
loc_ac_cg[Y]  =  CG_AC_Y ; 
loc_ac_cg[Z]  =  CG_AC_Z; 

inertia_matrix[l]  [1]  =  MOMENT_OF_INERTIA_X; 
inertia_matrix[2]  [2]  =  MOMENT_OF_INERTIA_Y; 
inertia_matrix[3]  [3]  =  MOMENT_OF_INERTIA_Z; 

pitch_damping  =  PITCH_RATE_DAMPING_GAIN; 
roll_damping  =  ROLL_RATE_DAMPING_GAIN; 
yaw_damping  =  YAW_RATE_DAMPING_GAIN; 


MAIN_ROTOR_MAST_TILT_SIN  =  sin (MAIN_ROTOR_MAST_TILT) ; 
MAIN_ROTOR_MAST_TILT_COS  =  cos {MAIN_ROTOR_MAST_TILT) ; 


I 


vec_init 

vec_init 

vec_init 

vec_init 

vec_init 

vec_init 

vec_init 

vec_init 

vec_init 

vec_init 


(vstab_force) ; 

(drag_force)  ; 

(ground_force) ; 

( force_ground_ef feet)  ; 
(force_body) ; 

(inoment_body )  ; 

(moment_body_torque_coupling> ; 
( force_body_main_rotor) ; 

{ force_body_tail_rotor) ; 
{force_body_damping) ; 


vehicle_inass_init  {AIRFRAME_MASS  +  ORDINANCE_MASS,  inertia_matrix  ) ; 
ground_init ( ) ; 

for  (i=0;  i<9;  i++)  /*  Set  parasite  drag  profile  */ 

{ 

p_drag_fit_coef f [i]  =  0.0; 

} 


if  {find_cubic_func  (0.0,  P_DRAG_COEFF_CONST , 

P_DRAG_T AS_BREAK ,  P_DRAG_COEFF_BREAK , 

P_DRAG_TAS_MAX,  P_DRAG_COEFF_MAX , 

0.5,  p_drag_f it_coef f )  1=  TRUE) 

fprintf  (stderr,  "AERODYN:  Error  -  unable  to  fit  p_drag  function\n" ) ; 

} 


/*  So  one  can  twea)^  the  constants  without  recompiling  */ 


if  (selected_model) 

aerodyn_read_simple_constants  (get_constants_f ile  {)), 


} 

static  void  get_aircraf  t_>;inematic_state  ( ) 

{ 

orientation_calc { ) ; 
parameters_calc ( ) ; 
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true_airspeed  =  kinematics_get_true_airspeed { ) , 

altitude  =  kinematics_get_altitude  ( )  ;  ,  i  \ 

angular_velocity_vector  =  kinematics_get_angular_velocity  vector () ; 
no?inalized_velocity_vector  =  kinematics_get_normalized_yelocity_vector { ) ; 
velocity_vector  =  kinematics_get_linear_velocity_vector ( ) ; 
gravity_dir_vector  =  kinematics_get_gravity_vector { ) ; 
angle_of_attack  =  kinematics_get_aoa ( ) ; 
side_slip_angle  =  -  kinematics_get_yaw( ) ; 

velocity_to_body  =  kinematics_get_velocity_to_body { ) ; 

g_force  =  kineinatics_get _ g_force()  , 

vertical_speed  =  kinematics_get_vertical_speed { ) ; 


static  void  deb_inat_print  (in) 

T_MATRIX  m; 

{ 

int  i  ; 

for  (i=0;  i<=2;  i++) 

^  printf  (nO.Slf  %0.31f  %0 . 31f \n" ,  m[  i  ]  [  0  ]  ,  m[  i  ]  [1]  ,  m[  i  ]  [2  ] )  ; 

} 

}' 


static  void  coinpute_f  light_parameters  ( ) 

ainbient_density  =  air_density  (altitude)  ; 
ambient_temperature  =  air_temperature (altitude) ; 

ambient_pressure  =  air_pressure  (altitude); 

dynamic_pressure  =  0.5  *  ambient_density  *  square  (true_airspeed) , 
pitch_rate  = ’ angular_velocity_vector [X] ; 
roll_rate  =  angular_velocity_vector [Y] ; 

Yaw_rate  =  angular_velocity_vector [Z] ;  ^ 

roll  =  atan2  (-gravity_dir_vector [X] ,  -gravity_dir_vector [Z] ) ; 
pitch  =  atan2  (-gravity_dir_vector [Y] ,  -gravity_dir_vector [Z] ) ; 

} 


static  void  interact_with_ground ( ) 

{ 

REAL  brake_f actor ; 

brake_f actor  =  normalized_velocity_vector [Y]  * 

true_airspeed  /  (true_airspeed  +  5) ; 
body_point[0] .x_force  =  -  6000  *  brake_factor; 
body_point [1] .x_force  =  body_point[0].x_force; 

ground_interact ion ( ground_f orce , ground_torque , body_point ,  grnd , 
NUMBER_OF_BODY_POINTS) ; 


f orce_ground_ef  f ect  [ Z ]  =  iiiain_rotor_thrust 

*  MAIN_ROTOR_GROUND_EFFECT_FACTOR 
/  (cig_altitude_above_gnd( )  +  1.0); 

} 

/************************************************/ 

/*  fuel  get  current  level  returns  gallons  */ 
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/*  gals  *  (6.5  lbs  /  gal)  *  {1kg  /  2.2  lbs)  */ 

/************************************************/ 
#define  KILOGRAMS_PER_GALLON  2.95454545454 


static  void  compute_gross_weight { ) 

{ 

vehicle_mass  =  AIRFRAME_MASS  +  ORDINANCE_MASS  + 

fuel_get_current_level { )  *  KILOGRAMS_PER_GALLON; /*  kg  */ 

gross_weight  =  vehicle_mass  *  GRAV_CONSTANT ;  /*  N  */ 

} 

void  aerodyn_set_lateral_stick  (val) 

REAL  val; 

{ 

cyclic_roll  =  -val; 

) 

void  aerodyn_set_longitudinal_stick  (val) 

REAL  val ; 

{ 

(  cyclic_pitch  =  -val; 

) 

void  aerodyn_set_pedal  (val) 

REAL  val; 

{ 

pedal  =  val; 

} 


void  aerodyn_set_collective  (val) 

REAL  val; 

{ 

if  (funny_little_kludge) 

collective  =  loglO  (val  *  9.0  +  1.0);  /*  or,  how  to  make  linear  log  */ 
else 

collective  =  val; 

) 


static  void  compute_lif t_drag_forces() 

{ 

lif t_virtual_wing  =  dynamic_pressure  * 

lif t_coef f icient_virtual_wing  *  VIRTUAL_WING_AREA; 


lift_vstab  =  dynamic_pressure  *  lift_coef f icient_vstab  *  VSTAB_AREA; 


} 


total_drag  =  total_incompressible_drag_coef f icient  *  dynamic_pressure  * 
TOTAL_WETTED_SURFACE_AREA  ; 


static  void  compute_body_damping_forces_and_moments  { ) 

{ 

moment_body_damping  [X]  =  -  pitch_damping  *  pitch_rate; 
moment_body_damping  [Y]  =  -  roll_damping  *  roll_rate; 
moment_body_damping  [Z]  =  -  yaw_damping  *  yaw_rate; 
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force_body_damping [X]  =  -velocity_vector [X] 

force_body_damping [Y]  =  0.0; 

force_body_damping[Z]  =  -velocity_vector [Z] 

} 

static  REAL  virtual_wing_lif t_coef f icient  (alpha) 

REAL  alpha; 

^  if  (alpha  >  WING_STALL_AOA  II  alpha  <  0.0) 
return  (0.0); 

else  ,  , 

return  ( ( (WING_LIFT_COEFFICIENT_FIT_3  *  alpha  + 
WING_LIFT_COEFFICIENT_FIT_2)  *  alpha  + 
WING_LIFT_COEFFICIENT_FIT_l)  *  alpha  + 
WING_LIFT_COEFFICIENT_FIT_0) ; 


static  REAL  vstab_lift_coeff icient  (yaw) 

REAL  yaw; 

{ 

•  REAL  yawval ; 

if  (abs(yaw)  >  VSTAB_STALL_SSA) 

yawval  =  sign (yawval)  *  VSTAB_STALL_SSA; 
else 

yawval  =  yaw; 

return  (VSTAB_LIFT_C0EFFICIENT_1  *  yawval); 

} 

static  void  compute_lif t_drag_coef f icients ( ) 

{ 

REAL  multiplier; 

lift_coef ficient_vstab  =  vstab_lift_coeff icient  (side_slip_angle) ; 

/*  Computing  virtual  wing  coefficient  as  independent  of  AOA  / 
lift_coef f icient_virtual_wing  =  LIFT_COEFF_VIRTUAL_WING; 

/*  virtual_wing_lift_coeff icient  (angle_of_attac]c) ;  */ 

parasite_drag_coeff icient  =  cubic_func  (true_airspeed,  p_drag_f it_coef f ) 

if  (true_airspeed  >  0.0  &&  angle_of_attacl<.  >0.0)  /*  speed  bralce  */ 

multiplier  =  5.0  *  true_airspeed  *  sin (angle_of_attac)c)  ; 
if  (multiplier  >  1.0) 

parasite_drag_coef ficient  *=  multiplier; 

} 

oswald_ef f iciency_factor  =  OSWALD_EFFIC_F ACTOR; 
induced_drag_coef ficient  =  INDUCED_DRAG_COEFF ; 

total_incompressible_drag_coef ficient  =  parasite_drag_coef ficient  + 

induced_drag_coef  f icient ; 


*  LATERAL_VELOCITY_DAMPING_GAIN; 

*  VERTICAL_RATE_DAMPING_GAIN; 
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static  void  send_to_dynainics_kinematics  { ) 

vehicle_mass_init  (vehicle_mass,  inertia_matrix) ; 
vehicle_forces  { force_body ) ; 
vehicle_torques  {moment_body) ; 


void  duinp_forces  { ) 

^  vec_dump  ( " lift_body_virtual_wing : " ,  lift_body_virtual_wing) ; 
vec_duinp  { " lift_body_vstab: “ ,  lif t_body_vstab) ; 
vec_dump  { '•  drag_body : " ,  drag_body)  ; 

vec_dump  ( "gravity_force_body ; “ ,  gravity_force_body ) ; 
vec_dump  { “ force_body_main_rotor : “ ,  force_body_main_rotor) ; 
vec_dump  { " force_body_tail_rotor : " ,  force_body_tail_rotor ) ; 
vec_dump  ( ''ground_force  :  “ ,  ground_force)  ; 
vec_dump  { " f orce_body : “ ,  f orce_body ) ; 

} 

void  sum _ body _ forcss _ and _ ^moments — about — ac  { ) 

{ 

vec_init  ( force^ody)  ;  _  ,  j  > 

vec_add  (force_body,  force_body_main_rotor,  force_body) ; 

/*  vec_add  (force_body,  force_body_tail_rotor ,  force_body) ;  / 

vec_add  {force_body,  lift_body_virtual_wing,  force_body); 
vec_add  (force_body,  lif t_body_vstab,  force_body) ; 
vec_add  (force_body,  drag_body,  f orce_body ) ; 
vec_add  {force_body,  force_body_damping,  force_body); 
vec_add  (force_body,  gravity_force_body,  force_body) 
vec_add  (force_body,  ground_force, force_body) ; 
vec_add  (force_body,  force_ground_ef f act,  force_body); 

vec_cross_prod(loc_ac_tail_rotor_cop,  force_body_tail_rotor , 

moment_body_tail_rotor) ; 

vec_cross_prod{loc_ac_virtual_wing_cop, lift_body_virtual_wing, 

moment_body_virtual_wing ) ; 

vec_cross_prod{loc_ac_vstab_cop,  lift_body_vstab,  moment_body_vstab) ; 
vec_cross_prod(loc_ac_cg,  gravity_force_body ,  moment_body_cg) ; 

vec_init  {moment_body)  ;  _  u  \  . 

vec_add  (moment_body ,  moment_body_main_rotor,  moment_body) ; 
vec_add  {moment_body ,  moment_body_tail_rotor ,  moment_body) ; 
vec_add  (moment_body ,  moment_body_virtual_wing,  moment_body) ; 
vec_add  (moment_body ,  moment_body_vstab,  moment_body ) ; 
vec_add  (moment_body ,  moment_body_cg ,  moment_body) ; 
vec_add  {moment_body ,  ground_torque ,  moment_body ) ; 
vec_add  {moment_body ,  moment_body_damping,  moment_body ) ; 


static  void  transform_lift_drag_forces_to_body_coordinates ( ) 

virtual_wing_force [Z]  =  lift_virtual_wing ;  /*  [H,  D,  L]  / 
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vstab_force [X]  =  lift_vstab; 
drag_force[Y]  =  -total_drag ; 

if  (true_airspeed  <  P_DRAG_TAS_BREAK)  /*  jwc  8/90  */ 

drag_force[Y]  -=  sin(pitch)  *  50000; 

vec_mat_iT(ul  {virtual_wing_force,  velocity_to_body,  lift_body_virtual_wing)  ; 
vec_mat_inul  {vstab_force,  velocity_to_body,  lif t_body_vstab) ; 
vec_mat_mul  {drag_force,  velocity_to_body ,  drag_body) ; 


static  void  generate_gravity_body_force ( ] 


{ 


coinpute_gross_weight  ( )  ; 

gravity_force_body [X]  =  gravity_dir_vector [X]  *  g3ross_weight , 
gravity_force_body [Y]  =  gravity_dir_vector [Y]  *  gross_weight ; 
g2^avity_f orc6_body [ Z ]  =  gravity _ dir _ vector [Z]  *  gross_weight ; 


static  int  frame; 

t 

void  aerodyn_debug_print { ) 

REAL  roll,  pitch,  yaw,  heading,  airspeed_knots ,  weight_lbs,  thrust_lbs; 

REAL  *position; 

roll=atan2(-gravity_dir_vector[X],-gravity_dir_vector[Z])  *180.0  /  3.1416; 

pitch=atan2 { -gravity_dir_vector [Y] , -gravity_dir_vector [Z] )*180.0  /  3.1416; 

yaw  =  side_slip_angle; 

airspeed_knots  =  true_airspeed  *  3.26  /  1.69; 

weight_lbs  =  gross_weight  /  9.8  *  2.2; 

position  =  vehicle_A_p { ) ; 

heading  =  rad_to_deg  {kinematics_get_heading ( ) ) ; 

printf  ("KTAS  =  %0.21f  W  =  %0.31f  %0.31f  %0.31f  YR  =  %0.31f\n", 

airspeed_knots,  velocity_vector [X] ,  velocity_vector [Y] , 
velocity_vector [Z] ,  angular_velocity_vector [Z] ) ; 

printf  ("xyzh  =  %0.31f  %0.31f  %0.31f  %0.21f  rpy  =  %0.31f  %0.31f  %0.31f\n'', 
position[X],  position[Y],  position[Z],  heading, 
roll,  pitch,  yaw) ; 

if  { hove r_hold_s tat e  ==  ON) 

printf  ( "stab_aug  [rpyc]  :  %0.31f  %0.31f  %0.31f  %0.31f\n'', 

stab_aug_roll ,  stab_aug_pitch,  stab_aug_yaw,  stab_aug_climb) ; 

} 


static  void  ccxnpute_rotor_loads ( ) 

main_rotor_load_torque  =  controller_collective  * 

MAIN_ROTOR_MAX_LOAD_TORQUE ; 

tail_rotor_load_torque  =  abs  ( control ler_tail_rotor)  * 

TAIL_ROTOR_MAX_LOAD_TORQUE ; 

) 


static  void  compute_engine_torque ( ) 

^  engine_simul (main_rotor_load_torque,  tail_rotor_load_torque,  altitude); 
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powertrain_percent_shaft_speed  =  engine_get_rotor_percent_shaf t_speed { ) ; 

} 

static  void  compute_rotor_forces_and_moments ( ) 

^  main_rotor_thrust  =  powertrain_percent_shaf t_speed  *  controller_collective 

*  MAIN_ROTOR_MAX_THRUST; 

tail_rotor_thrust  =  powertrain_percent_shaf t_speed  *  control ler_tail_rotor 

*  TAIL_ROTOR_MAX_THRUST ; 

force_bodY_main_rotorlY]  =  main_rotor_thrust  *  MAIN_ROTOR_MAST_TILT_SIN; 
force_body_main_rotor[Z]  =  main_rotor_thrust  *  MAIN_ROTOR_MAST_TILT_COS ; 
force_body_tail_rotor[X]  =  tail_rotor_thrust ; 


f 


moment_body_itiain_rotor  [X]  - 

-  controller_cyclic_pitch 

nioment_body_main_rotor  [  Y  ]  = 

controller_cyclic_roll  * 
monient_body_inain_rotor  [  Z  ]  = 

-  main_rotor_load_torque 


*  MAIN_R0T0R_MAX_PITCH_M0MENT; 
MAIN_ROTOR_MAX_ROLL_MOMENT ; 

*  MAIN_R0T0R_T0RQUE_C0UPLING_GAIN ; 


Static  REAL  limiter  (lower,  val,  upper) 
REAL  lower,  val,  upper; 

{ 

if  (val  >  upper)  return  (upper) ; 
else  if  (val  <  lower)  return  (lower); 
else  return  (val) ; 

} 


static  REAL  set_roll_attitude  (angle) 

REAL  angle; 

‘  attitud._control_ron_integr.cor  «  ATT_CTL_ROLL_I_GAIN  •  (roll  -  angle)  ; 
/****  These  used  to  be  attitude_control_pitch_integrator  instead  ot 
attitude_control_roll_integrator .  PJM  11-1-89 

attitude_control_pitch_integrator  =  t  i 

limiter  (-0.1,  attitude_control_pitch_integrator ,  0.1); 

****** ! 

attitude_control__roll_integrator  =  ^  i  i 

limiter  (-0.1,  attitude_control_roll_integrator ,  0.1); 

attitude_control_roll_command  =  ATT_CTL_R0LL_P_GAIN  *  (rol  -  ang  e  , 

attitude_control_roll_=o«»nd  «  «“i5“^'-'=!^°lT”“;“p'?crSLL_C0NTR0L, 
attitude_control_roll_command  =  limiter  (  MAX_bi _ 

a  1 1 i tude_con  t  r o l_ro 1 l_command , 

MAX_STAB_AUG_PITCH_R0LL_C0NTR0L) ; 
return  (attitude__control_roll__command)  ; 


static  REAL  set_pitc)i_attitude  (angle) 
REAL  angle; 

{ 

attitude_control_pitch_integrator  += 


-  B-18  - 


Reference# W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


APPENDIX  B  -  rwa_aerodyn.c 


ATT_CTL_PITCH_I_GAIN  *  (pitch  -  angle) ; 
attitude_control_pitch_integrator  =  ^  ^  i  \ 

limiter  (-0.1,  attitude_control_pitch_integrator ,  0.1); 

attitude_control_pitch_command  =  ATT_CTL_PITCH_P_GAIN  *  (pitch  -  angle) ; 
attitude  control  pitch  command  +=  attitude_control_pitch_integra  or, 
fttiSdtcontroliiCchlcoMnand  ,  limiter  l-MM_STAB_AUG_PITCH_ROLL_CO»TEOL, 

att  itude_control„pitch__command , 
MAX_STAB_AUG_PITCH_R0LL_C0NTR0L) ; 
return  (attitude_control_pitch_command) ; 


static  void  compute_stab_augmentation_gains ( ) 

if  (hover_hold_state  ==  ON) 

{ 

if  (  !hover_hold_turned_on  ) 

{ 

hover_hold_turned_on  =  TRUE  ; 


pitch_damping  =  2  *  PITCH_RATE_DAMPING_GAIN;  /*  jwc  8/90  */ 
iToll  damping  =  2  *  ROLL _ RATE _ DAMPING — ^GAIN; 

/*  You  should  already  be  "hovering"  (airspeeds  10  )cnots) 
for  hover  hold  to  show  little  visible  swaying.  */ 


hover_aug_roll_integrator  ; 
hover_aug_pitch_integrator 
stab_aug_yaw_integrator  = 
stab_aug_climb_integrator 


=  0.0  ; 

=  HOVER_AUG_PITCH_RESET_VALUE 

0.0  ; 

=  0.0  ; 


#if  ATT_DAMPING_MODE_SIMPLE 

if  ( true_airspeed  <  HOVER_SLOW_LIMIT) 

if  ( true_airspeed  >  -HOVER_SLOW_LIMIT) 

MAX_ATT_CTL_ANGLE  =  MAX_ATT_CTL_ANGLE_SLOW  ; 
else  if  ( true_airspeed  >  -HOVER_MED_LIMIT) 
MAX_ATT_CTL_ANGLE  =  MAX_ATT_CTL_ANGLE_MED ; 
else 

MAX_ATT_CTL_ANGLE  =  MAX_ATT_CTL_ANGLE_NORM  ; 

else  if  ( true_airspeed  <  HOVER_MED_LIMIT) 

MAX_ATT_CTL_ANGLE  =  MAX_ATT_CTL_ANGLE_MED  ; 

else 

MAX_ATT_CTL_ANGLE  =  MAX_ATT_CTL_ANGLE_NORM  ; 

#endif 

} 


# i f  att_damping_mode_simple 

if  ( true_airspeed  >  HOVER_SLOW_LIMIT  ) 

MAX_ATT_CTL_ANGLE  = 

log(  true_airspeed  )  *  MAX_ATT_DAMPING_FACTOR  ; 

else  if  {true_airspeed  <  -HOVER_SLOW_LIMIT  ) 
MAX_ATT_CTL_ANGLE  = 

log (  -true_airspeed  )  *  MAX_ATT_DAMPING_FACTOR  ; 
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else 

MAX_ATT_CTL_ANGLE  =  MAX_ATT_CTL_ANGLE_STOP  ; 
MAX_ATT_CTL_ANGLE  =  deg_to_rad(  MAX_ATT_CTL_ANGLE  ) ; 

tendif 


hover_aug_roll_integrator  += 

HOVER_AUG_ROLL_I_GAIN  *  velocity_vector [X] ; 
hover_aug_roll_integrator  = 

limiter (-0 .2,hover_aug_roll_integrator,  0.2) ; 
hover_aug_roll_angle  =  HOVER_AUG_ROLL_P_GAIN  *  velocity_vector [X] 

+  hover_aug_roll_integrator ; 
hover_aug_rol l_angle  =  limiter  ( -MAX_ATT_CTL_ANGLE , 

hover_aug_rol l_ang 1 e , 

MAX_ATT_CTL_ANGLE) ; 

stab_aug_roll  =  set_roll_attitude  (hover_aug_roll_angle) ; 

hover_aug_pitch_integrator  += 

HOVER_AUG_PITCH_I_GAIN  *  velocity_vector [Y J ; 
hover_aug_pitch_integrator  = 

limiter (-0 . 2 , hover_aug_pitch_integrator , 0 .2) ; 
hover_aug_pitch_angle  =  HOVER_AUG_PITCH_P_GAIN  *  velocity_vector [Y] 

+  hover_aug_pitch_integrator; 
hover_aug_pitch_angle  =  limiter  ( -MAX_ATT_CTL_ANGLE , 

hover_aug_p i t  ch_ang 1 e , 

MAX_ATT_CTL_ANGLE) ; 

stab_aug_pitch  =  set_pitch_attitude  (hover_aug_pitch_angle) ; 

stab_aug_yaw_integrator  -= 

HOVER_AUG_YAW_I_GAIN  *  angular_velocity_vector [ Z ] ; 
if  {stab_aug_yaw_integrator  >  0.5)  stab_aug_yaw_integrator  = 

if  (stab_aug_yaw_integrator  <  -0.5)  stab_aug_yaw_integrator  =  -0.5; 
stab_aug_yaw  =  -  HOVER_AUG_YAW_P_GAIN  *  angular_velocity_vector [Z]  + 

stab_aug_yaw_integrator ; 

stab_aug_climb_integrator  -= 

HOVER_AUG_CLIMB_I_GAIN  *  velocity_vector [Z] ; 
if  {stab_aug_climb_integrator  >  0.2)  stab_aug_climb_integrator  = 

if  (stab_aug_climb_integrator  <  -0.2)  stab_aug_climb_integrator  =  -  .  , 

stab_aug_climb  =  -  HOVER_AUG_CLIMB_P_GAIN  *  velocity_vector [Z]  + 
stab_aug_climb_integrator ; 

stab_aug_yaw  =  limiter  {-MAX_STAB_AUG_YAW_CLIMB_CONTROL, 

stab_aug_yaw, 

MAX_STAB_AUG_YAW_CLIMB_CONTROL)  ; 

stab_aug_climb  =  limiter  (-MAX_STAB_AUG_YAW_CLIMB_CONTROL, 

s  tab_aug_c 1 imb , 

MAX_STAB_AUG_YAW_CLIMB_CONTROL) ; 

} 

else 

{ 

stab_aug_roll  =  0.0; 
stab_aug_pitcli  =  0.0; 
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stab_aug_yaw  =  0.0; 
s  tab_aug_c 1 imb  =  0.0; 

pitch_damping  =  PITCH_RATE_DAMPING_GAIN;  /*  jwc  8/90  */ 
r'oll_damping  =  ROLL_RATE_DAMPING_GAIN; 


#ifdef  notdef 

hover_aug_roll_integrator  =  0.0; 
hover_aug_pitch_integrator  =  0.0; 


/*  added  8/31/89  (jwc) 


#endif 

controller_cyclic_roll  =  cyclic_roll  +  stab_aug_roll ; 
controller_cyclic_pitch  =  cyclic_pitch  +  stab_aug_pitch; 
controller_tail_rotor  =  pedal  +  stab_aug_yaw; 
controller_collective  =  collective  +  stab_aug_climb; 


) 


*/ 


static  void  send_aero_data_to_displays ( ) 

{ 

if  {velocity_vector [Y]  >  0.0) 

meter_air_speed_set {true_airspeed) ; 

'  else 

ineter_air_speed_set  (0.0); 


meter_altitude_set (altitude) ; 
meter_vertical_speed_set (vertical_speed) ; 


void  aerodyn_simul ( ) 

{ 

get_aircraft_kinematic_state ( ) ; 
coinpute_f  light_paraineters  ( ) ; 
compute_stab_augnientation_gains  ()  ; 
compute_rotor_loads ( ) ; 
coinpute_engine_torque  ( )  ; 
conipute_rotor_forces_and_inoments  ( )  ; 
compute_lif t_drag_coef f icients ( ) ; 
coinpute_lift_drag_forces  ( )  ; 

compute_body_damping_forces_and_inoments ( ) ; 
transform_lift_drag_forces_to_body_coordinates ( ) ; 
generate_gravity_body_force ( ) ; 
interact_with_ground( ) ; 

suin_body_forces_and_moments_about_ac  ( )  ; 
send_to_dynamics_kinematics ( ) ; 

/*  send_aero_data_to_displays() ;  Must  call  if  not  calling  orientation, 
vehicle_update ( ) ; 

} 


REAL  aerodyn_get_true_airspeed() 

{ 

return  (true_airspeed) ; 

} 

void  aerodyn_set_hover_hold_on  () 

{ 


,calc  */ 
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hover_hold_state  =  ON; 

} 

void  aerodyn_set_hover_hold_of f () 

{ 

hover_hold_state  =  OFF; 
hover_hold_turned_on  =  FALSE; 
level_view  =  TRUE; 

) 

void  aerodyn_toggle_hover_hold{) 

{ 

if  {hover_hold_state  ==  OFF) 
hover_hold_state  =  ON; 
else 
{ 

hover_hold_state  =  OFF; 
hover_hold_turned_on  =  FALSE; 

) 

} 

vioid  forces_init  {) 

{ 

aerodyn_init { ) ; 

} 

/*************************************************************************** 

*  The  following  stuff  is  for  the  simplified  dynamics  model.  The  model  is  * 

*  a  modification  of  the  aerodynamics  model  Warren  wrote  for  the  SAF .  * 

*  Global  variables  defined  for  the  real  aerodynamics  are  reused  here  to  * 

*  allow  overlap  in  generic  routines  for  operations  such  as  control  inputs,* 

*  init,  etc.  -  CJC  * 

***************************************************************************/ 


#define  MAX_HELICOPTER_POWER 

aero_simple [ 

0 

#define  MAX_HH 

aero_simple [ 

1 

/*  constants  for  tweaking  */ 

#define  H_K1 

aero_simple [ 

2 

# define  H_K2 

aero_simple [ 

3 

/*  as  increase 
idefine  H_K7 
#define  H_K8 
#define  H_KP 
#define  H_KPR 
Sdefine  H_KY 
# define  H_KH 
#define  H_CHH 
#define  H_CL 


drag  coefficients,  helicopter  slows  down  faster 
aero_simple[  4] 
aero_simple[  5] 
aero_simple[  6] 
aero_simple[  7] 
aero_simple[  8] 
aero_simple[  9] 
aero_simple[10] 
aero_simple [11] 


*/ 


void  aerodyn_simple_simul  {) 

{ 
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register  int  i ; 
register  REAL  *vec_ptr; 
register  REAL  *res_ptr; 
register  REAL  *cur_ptr; 
register  REAL  *des_ptr; 

REAL  *drag_ptr; 

REAL  power; 

REAL  col l_f actor ; 

REAL  lif t_f actor ; 

VECTOR  orient_vec; 

VECTOR  angular_accel ; 

VECTOR  hover_hold_additions ; 

REAL  euler[3];  /*  euler  angles  */ 

VECTOR  gravity_vector;  /*  in  body  coordinates  */ 

T_MAT_PTR  C_mat;  /*  direction  cosine  matrix  */ 

get_aircraf t_kinematic_state  () ; 
generate_gravity_body_force ( ) ; 
compute_rotor_loads ( ) ; 
compute_engine_torque ( ) ; 

if  {hover_hold_state  ==  ON) 

{ 

hover_hold_additions [0]  =  min {velocity_vector [ 1 ]  *  H_KH,MAX_HH); 
hover_hold_additions [0]  =  max{hover_hold_additions [0] , -MAX_HH) ; 
hover_hold_additions [1]  =  min{-  velocity_vector [ 0 ]  *  H_KH,MAX_HH); 
hover_hold_additions [1]  =  max(hover_hold_additions [ 1 ] , -MAX_HH) ; 
hover_hold_additions [2 ]  =  -  velocity_vector [2 ]  *  H_KH  *  H_CHH; 

else 

{ 

hover_hold_additions [0]  =  0; 
hover_hold_additions [1]  =  0; 
hover_hold_additions [2 ]  =  0; 

} 

lift_factor  =  velocity_vector [1]  *  velocity_vector [1]  *  H_CL  * 

-  cyclic_pitch; 

/**  original  comment  from  SAF  code  **/ 

/*  may  want  to  put  in  power  limit  per  unit  time  ...  */ 

coll_factor  =  max { 0 . 0 , collective  -  0.3); 

power  =  H_KP  *  coll_factor  +  hover_hold_additions [2 ] ; 

power  +=  gross_weight  *  collective/ (H_K2+collective)  *  1.25; 

power  =  min  (MAX_HELICOPTER_POWER,  power) ; 

power  =  max  {0.0,  power); 

if  ( fuel_level_empty  ()) 
power  =0.0; 

/*  Calculate  the  torque  required  to  achieve  the  desired  orientation  */ 
/*  orientation  vector  is  [pitch  element,  roll  element,  yaw  element]  */ 

orient_vec [ 0]  =  H_KPR  *  -  cyclic_pitch  +  hover_hold_additions [ 0 ] ; 
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orient_vec [ 1 ]  =  H_KPR  *  cyclic_roll  +  hover_hold_additions [ 1 ] ; 

/**  yaw  element  =  current_yaw  (heading)  +  rudder  (pedals)  *  K  **/ 
orient_vec  [2 ]  =  l<.inematics_get_yaw  ()  +  sign(pedal)  *  pedal 
*  pedal  *  H_KY; 

res_ptr  =  moment_body; 
des_ptr  =  orient_vec; 

C_mat  =  ]<inematics_get_w_to_h  (veh_)<:inematics)  ; 

euler[0]  =  atan2  (-gravity_dir_vector [Y] ,  -gravity_dir_vector [Z] ) ; 
euler[l]  =  -  atan2  ( -gravity_dir_vector [X] ,  -gravity_dir_vector [Z] ) ; 
euler[2]  =  )<inematics_get_yaw  ( )  ; 
cur_ptr  =  euler; 

/*  First,  compute  the  angular  velocity  necessary  to  achieve  the  */ 

/*  desired  orientation  in  exactly  one  ticl<.  (delta  theta/  delta  T)  */ 

/*  Then  get  the  angular  acceleration  needed  to  get  to  that  velocity  */ 

/*  In  one  tick.*/ 
for  (i  =  X;  i  <=  Z;  ++i) 

{ 

vec_ptr[i]  =  ((des_ptr[i]  -  cur_ptr[i])  /  DELTA_T  /  H_K1) ; 
angular_accel ( i ]  =  (vec_ptr[i]  -  angular_velocity_vector [ i ] ) 

/  DELTA_T; 

res_ptr[i]  =  MOMENT_OF_INERTIA_X  *  angular_accel [ i ] ; 

} 

res_ptr[X]  +=  lift_factor ;  /*  this  should  add  some  torque  for  turns  */ 

/*  compute  force  vector  */ 
res_ptr  =  force_body; 
cur_ptr  =  velocity_vector ; 
vec_ptr  =  euler; 

drag_ptr  =  drag_force;  /*  drag_body  or  drag_force  */ 

drag_ptr[X]  =  square (cur_ptr[X] )  *  H_K8; 
drag_ptr[Y]  =  square (cur_ptr [Y] )  *  H_K7; 
drag_ptr[Z]  =  square (cur_ptr [Z] )  *  H_K8; 

res_ptr[X]  =  (sin (vec_ptr [Y] )  *  power)  -  (sign (cur_ptr [X] )  *  drag_ptr [X] ) ; 
res_ptr[Y]  =  - (sin (vec_ptr [X] )  *  power)  -  (sign (cur_ptr [Y] )  *  drag_ptr[Y]) 

res_ptr[Z]  =  C_mat[2][2]  *  power; 
res_ptr[Z]  -=  sign (cur_ptr [Z] )  *  drag_ptr[Z]; 

res_ptr[Z]  +=  lift_factor;  /*  this  should  add  some  force  for  lift  */ 

vec_add  (force_body,  ground_force, force_body) ; 
vec_add  (force_body,  gravity_force_body, force_body)  ;' 
interact_with_ground ( ) ; 

vec_add  (force_body,  force_ground_ef feet,  force_body) ; 
vec_add  (moment_body ,  ground_torque,  moment_body) ; 
send_to_dynamics_kinematics  (); 
vehicle_update  (); 
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*  The  following  is  for  the  simplified  model  incorporating  the  stealth 

*  dynamics.  In  this  model,  the  cyclic  changes  the  desired  velocity 
***********************************************************************/ 


Sdefine  H_FWD_MUL  aero_stealth [  0] 

#define  H_SIDE_MUL  aero_stealth [  1] 

#define  H_COLL_MUL  aero_stealth [  2] 

Sdefine  MAX_TORQUE  aero_stealth[  3] 

#define  MAX_FORCE  aero_stealth [  4] 

#define  MASS  aero_stealth [  5] 

#define  INERTIA  aero_stealth [  6] 

#define  DEAD_ZONE  aero_stealth [  7] 

/*  use  for  gravity  frame  matrix,  eliminate  all  pitch  and  roll 
*  start  with  identity.  substitute  cos  (yaw)  for  last  term. 

*/ 

static  T_MATRIX  level  =  {(1.0,  0.0,  0.0}, 

(0.0,  1.0,  0.0), 

(0.0,  0.0,  1.0}}; 


void  aerodyn_stealth_simul  () 

{ 

VECTOR  desired_rot_vel ; 

VECTOR  desired_lin_vel; 

REAL  adj_collective;  /*  collective  value  adjusted  for  dead  zone  and 
for  -1  to  1  range  */ 

adj_collective  =  (collective  -  0.5}  *  2.0;  /*  change  to  -1  to  1  */ 

if  (aerodyn_debug) 

timed_printf  ("adj.collective  =  %.31f\n”,  adj_collective) ; 

if  (allow_takeof f ) 

{ 

if  {adj_collective  >  0.0) 

( 

allow_takeof f  =  FALSE; 

} 

else 

{ 

adj_collective  =  0.0; 

} 

} 

get_aircraf t_kinematic_state  {) ; 
compute_rotor_loads ( ) ; 
compute_engine_torque { ) ; 

/*  update  desired  velocity  */ 

desired_lin_vel [Z]  =  ad j_collective  *  adj_collective  * 
sign  (adj_collective  )  *  H_COLL_MUL; 

if  {hover_hold_state  ==  ON) 
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{  /*  no  linear  velocity  in  X,Y,  only  pitch  */ 

desired_lin_vel [X]  =  desired_lin_vel [Y]  =  0.0; 

desired_rot_vel [X]  =  -cyclic_pitch  *  cyclic_pitch  *  sign {cyclic_pitch) ; 
desired_rot_vel [Y]  =  0.0; 

} 

else 

{ 

if  { level_view) /*  when  not  in  pitch  mode,  level  view  */ 

{ 

vehicle_set_orientation_matrix  (level);  /*  identity  matrix  */ 
vehicle_set_orientation  {kinematics_get_heading ()); 
level_view  =  FALSE; 

} 

desired_lin_vel [X]  =  cyclic_roll  *  cyclic_roll  *  sign  (cyclic_roll) 

*  H_SIDE_MUL; 

desired_lin_vel [Y]  =  cyclic_pitch  *  cyclic_pitch  *  sign  {cyclic_pitch) 

*  H_FWD_MUL; 

desired_rot_vel [X]  =  desired_rot_vel [Y]  =  0.0; 

} 

#ifdef  notdef 

desired_lin_vel [X]  =  cyclic_roll  *  cyclic_roll  *  sign  {cyclic_roll) 

*  H_SIDE_MUL; 

desired_lin_vel [Y]  =  cyclic_pitch  *  cyclic_pitch  *  sign  {cyclic_pitch) 

*  H_FWD_MUL; 

desired_rot_vel [X]  =  desired_rot_vel [Y]  =  0.0; 

#endif 

desired_rot_vel [Z]  =  pedal  *  pedal  *  sign(pedal); 

/*  controller_forces  */ 

force_body [X]  =  (desired_lin_vel [X]  -  velocity _vector [X] ) 

*  MASS/DELTA_T; 

force_body [Y]  =  {desired_lin_vel [Y]  -  velocity_vector [Y] ) 

*  MASS/DELTA_T; 

force_body [Z]  =  (desired_lin_vel [Z]  -  velocity_vector [Z] ) 

*  MAS S/ CELT A_T; 

force_body [X]  =  min  (MAX_FORCE,  force_body [X] ) ; 
force_body [Y]  =  min  (MAX_FORCE,  force_body [Y] ) ; 
force_body [Z]  =  min  {MAX_FORCE,  f orce_body [ Z ] ) ; 

force_body [X]  =  max  (-MAX_FORCE,  force_body [X] ) ; 
force_body [Y]  =  max  (-MAX_FORCE,  force_body[Y]); 
f orce_body [ Z ]  =  max  (-MAX_FORCE,  force_body [Z] ) ; 


/*  control ler_torques  */ 

moment_body [X]  =  {desired_rot_vel [X]  -  angular_velocity_vector [X] ) 

*  INERTIA/DELTA_T; 

moment_body [Y]  =  (desired_rot_vel [Y]  -  angular_velocity_vector [Y] ) 

*  INERT IA/DELTA_T; 

moment_body [Z]  =  {desired_rot_vel [Z]  -  angular_velocity_vector [Z] ) 

*  INERTIA/DELTA_T; 
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moment_body [X]  =  min  {MAX_TORQUE,  moment_body[X]); 
moment_body [ Y]  =  min  {MAX_TORQUE,  moment_body [Y] ) ; 
moment_body [ Z ]  =  min  (MAX_TORQUE,  moment_body [Z] ) ; 

moment_body [X]  =  max  { -MAX_TORQUE,  moment_body [X] ) ; 
moment_body [Y]  =  max  ( -MAX_TORQUE,  moment_body [Y] ) ; 
moment_body [ Z ]  =  max  ( -MAX_TORQUE,  moment_body [Z] ) ; 

interact_with_ground { ) ; 

vec^add  {force_body,  ground_force, force_body) ; 
vec_add  {force_body,  gravity_force_body, force_body ) ; 
vec_add  {force_body,  force_ground_ef feet,  force_body) ; 

send_to_dynamics_kinematics  { ) ; 
vehicle_update  { ) ; 


*  for  tweaking  purposes,  use  parameter  file  for  constants  * 

j***********************************************************************^ 

aerodyn_read_simple_constants  ( fn) 
char  *fn; 

{ 

char  *strtok  ( ) ; 

FILE  *fp; 
char  s [80 ] ; 

if  ((fp  =  FOPEN. (fn,  "r"))  ==  NULL) 

{ 

printf  ("no  tweakable  constants  file;  using  defaults\n",  fn) ; 
return  (-1) ; 

) 

else 

printf  ("Reading  tweakable  constants  file:  %s\n",  fn) ; 

while  (FGETS  (s,  80,  fp)  !=  NULL) 

{ 

char  *str; 

switch  (s[0])  /*  check  for  comments  or  blank  lines  */ 

{ 


case 

■#'  : 

case 

i  1  . 

case 

'  \n'  : 

case 

■\t'  : 

continue 

} 

str  =  strtok  (s,  “  \t"); 

if  (stremp  (str,  “H_K1")  ==  0) 

( 

sscanf  (strtok  (0,  "  \t"),  ”%lf",  &:H_K1); 
continue; 


-B-27- 


Reference  #W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 

APPENDIX  B  -  rwa_aerodyn.c 


} 

if  {strcmp  (str,  ''H_K2")  ==  0) 

{ 

sscanf  (strtok  (0,  “  \t"),  &H_K2); 

continue; 

} 

if  (strcmp  (str,  “H_K7")  ==  0) 

{ 

sscanf  (strtok  (O,'"  \t"),  ”%lf”,  S:H_K7)  ; 
continue ; 

) 

if  (strcmp  (str,  "H_K8")  ==  0) 

{ 

sscanf  (strtok  (0,  “  \t"),  “%lf”,  &H_K8) ; 
continue; 

} 

if  (strcmp  (str,  ''H_KP'')  ==  0) 

{ 

sscanf  (strtok  (0,  "  \t"),  “%lf“,  &H_KP) ; 
continue; 

} 

if  (strcmp  (str,  ''H_KPR“)  ==  0) 

{ 

sscanf  (strtok  (0,  "  \t“),  “%lf",  &H_KPR) ; 
continue; 

) 

if  (strcmp  (str,  "H_KY")  ==  0) 

{ 

sscanf  (strtok  (0,  "  \t"),  "%lf“,  &H_KY) ; 
continue; 

} 

if  (strcmp  (str,  "H_KH'')  ==  0) 

{ 

sscanf  (strtok  (0,  “  \t"),  “%lf'',  &H_KH)  ; 
continue; 

) 

if  (strcmp  (str,  "H_FWD_MUL")  ==  0) 

{ 

sscanf  (strtok  (0,  "  \t“),  "%lf",  &H_FWD_MUL) ; 
continue; 

} 

if  (strcmp  (str,  " H_COLL_MUL " )  ==  0) 

{ 

sscanf  (strtok  (0,  "  \t“),  "%lf“,  S:H_COLL_MUL)  ; 
continue ; 

) 
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I 


if  {strcmp  {str,  "H_CHH'')  ==  0) 

sscanf  (strtok  (0,  “  \t"),  ; 

continue; 

} 

if  {strcmp  (str,  "H_CL'')  ==  0) 

sscanf  (strtok  (0,  ”  \t“),  “%lf“,  £cH_CL)  ; 

continue; 

} 


if  (strcmp  (str,  “ MAX_FORCE “ )  —  0) 

^  sscanf  (strtok  (0,  “  \t"),  “%lf",  S:MAX_FORCE)  ; 

continue ; 

} 

if  (strcmp  (str,  "MAX_TORQUE“ )  ==  0) 

^  sscanf  (strtok  (0,  “  \t“),  “%lf",  &MAX_TORQUE) ; 

continue ; 


if  (strcmp  (str,  "MASS")  ==  0) 

^  sscanf  (strtok  (0,  "  \t"),  &MASS)  ; 

continue; 


if  (strcmp  (str,  "INERTIA")  ==  0) 

sscanf  (strtok  (0,  "  \t"),  S:INERTIA)  ; 

continue; 


if  (strcmp  (str,  "H_SIDE_MUL" )  —  0) 

^  sscanf  (strtok  (0,  “  \t"),  &H_SIDE_MUL) ; 

continue; 


if  (strcmp  (str,  "DEAD_ZONE")  ==  0) 

sscanf  (strtok  (0,  "  \t"),  “%lf”,  &DEAD_Z0NE) ; 

continue; 


/*  if  got  here  --  mistake  */ 

printf  ("ERROR:  Unknown  constant  %s  in  %s\n",  str,  fn) ; 

) 

FCLOSE  (fp); 

printf  ("done  reading  constants  file\n"); 

/*  aerodyn_dump_simple_constants  {);*/ 

return  (1); 
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} 


aerodyn_dump_control_inputs  {) 

printf  {"collective  =  %  .  21f \tcyclic_roll  =  %  .  21f \tcyclic_pitch  =  %.21f\n'' 
collective,  cyclic_roll,  cyclic_pitch) ; 
printf  (“pedal  =  %.21f\n",  pedal); 
aerodyn_debug  =  aerodyn_debug  ?  0  :  1; 

printf  ( "aerodyn_debug  is  %s\n“,  aerodyn_debug  ?  "on"  :  "off"); 


aerodyn_dump_siinple_constants  () 


{ 


t 


) 


printf  ("Aerodyn  simple  constants : \n“ ) ; 

printf  ("\tH_Kl:\t%.21f\n",  H_K1) ; 

printf  ("\tH_K2:\t%.21f\n“,  H_K2); 

printf  ("\tH_K7:\t%.21f\n",  H_K7); 

printf  ("\tH_K8:\t%.21f\n",  H_K8) ; 

printf  (“\tH_KP:\t%.21f\n“,  H_KP) ; 

printf  (“\tH_KPR;\t%.21f\n“,  H_KPR) ; 

printf  {"\tH_KY;\t%.21f\n“,  H_KY) ; 

printf  ("\tH_KH:\t%.21f\n",  H_KH) ; 

printf  {"\tH_FWD_MUL;\t%.21f\n",  H_FWD_MUL) ; 

printf  ("\tH_SIDE_MUL:\t%.21f\n",  H_SIDE_MUL) ; 

printf  ("\tH_C0LL_MUL:\t%.21f\n",  H_COLL_MUL) ; 

printf  ("\tH_CHH;\t%.21f\n“,  H_CHH) ; 

printf  (“\tH_CL:\t%.21f\n",  H_CL) ; 

printf  ("\tMAX_FORCE:\t%.21f\n“,  MAX_FORCE) ; 

printf  (“\tMAX_TORQUE:\t%.21f\n",  MAX_TORQUE) ; 

printf  ("\tMASS:\t%.21f\n",  MASS); 

printf  {"\tINERTIA:\t%.21f\n",  INERTIA); 

printf  ("\tDEAD_ZONE:\t%.21f\n",  DEAD_ZONE) ; 


set_selected_model  (model) 
int  model; 

{ 

switch  (model) 

{ 

case  COMPLEX_MODEL : 

printf  ("switching  to  complex  model,  logarithmic  collectiveXn  ); 
funny_little_'kludge  =  1;/*  logarithmic  collective  */ 
selected_model  =  model; 
brealc; 

case  SIMPLE_MODEL : 

printf  ("switching  to  simple  model,  linear  collectiveXn" ) ; 
funny_little_)cludge  =  0;/*  linear  collective  */ 
selected_model  =  model; 
break; 

case  STEALTH_MODEL : 

printf  ("switching  to  stealth  model,  linear  collective\n" ) ; 
funny_little_kludge  =  0;/*  linear  collective  */ 
selected_model  =  model; 
break ; 
default : 
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printf  {"invalid  selected  model  %d\n“,  model); 
printf  ("using  default  complex  model\n"); 
selected_model  =  COMPLEX_MODEL ; 
break; 

} 

} 

get_selected_model  ( ) 

return  (selected_model) ; 

} 

indicate_selected_model  (model) 
int  model; 

{ 

switch  (model) 

{ 

case  COMPLEX_MODEL : 

printf  ("using  complex  model\n“); 

break; 

'  case  SIMPLE_MODEL: 

printf  ("using  simple  model\n“); 
break; 

case  STEALTH_MODEL : 

printf  (“using  stealthmodel\n“); 

allow_takeof f  =  TRUE; 
break; 
default : 

printf  ("invalid  selected  model  %d\n",  model); 
printf  ("using  default  complex  modelXn"); 
break; 

} 

} 

set_takeoff_status  (status) 
int  status; 

{ 

allow_takeoff  =  status; 

) 
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understanding  of  the  CSU. 
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/*  $Header:  /a3/adst-cm/RWA/simnet/vehicle/rwa/src/RCS/rwa_engine . c , v  1.5  1992/1 

2/21  22:15:59  cm-adst  Exp  $  */ 

'*  ■  c 

*  $Log:  rwa_engine.c,v  5 

*  Revision  1.5  1992/12/21  22:15:59  cm-adst 

*  R  Branson's  flight  changes.  These  changes  will  become 

*  BDS-D  1.1.1.  This  change  was  turned  over  by  C.  Swanson. 

*  Revision  1.1  1992/10/07  19:00:23  cm-adst 

*  Initial  Version 

* 

ILtic  char  RCS_ID[]  =  “$Header:  /a3/adst-cm/RWA/simnet/vehicle/rwa/src/RCS/rwa_ 

engine. c,v  1.5  1992/12/21  22:15:59-  cm-adst  Exp  $“; 

/********************************************-***********************^ 

★ 


*  Revisions: 

★ 


Version 

Date 

Author 

1.2 

10/09/92 

R. 

Branson 

1.3 

10/16/92 

R. 

Branson 

1.4 

10/30/92 

R. 

Branson 

1.5 

01/19/93 

P.Desmeules 

Title 


SP/CR  Number 


Data  File  Initiali¬ 
zation 

Data  filenames  changed 
to  eight  characters 
Added  pathname  to  data 
directory 

Increased  the  size  of  the 
fgets  to  make  sure  the 
whole  line  is  read  in. 


31 


SP/CR  No.  Description  of  Modification 


★ 

* 

* 

★ 

★ 

★ 

★ 


Hard  coded  defines  changed  to  array  elements. 

Engine  data  array  added. 

Engine  initialization  data  array  added. 

Engine  status  data  array  added.  .  .  . 

Added  file  for  engine  data,  engine  initialization 
data,  and  engine  status  data  to  the  "engine.init 
function 

Added  " /simnet/data/ "  to  each  data  file  pathname. 

**********************************************/ 


/ 


* 


*  FILE: 

*  AUTHOR: 


rwa_engine .c 
James  Chung 
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*  MAINTAINER:  James  Chung 

*  HISTORY:  4/19/89  james:  Creation 

* 

★ 

*  Copyright  (c)  1989  BBN  Systems  and  Technologies  Corporation 

*  All  rights  reserved. 


★ 

★ 

* 

•k 

★ 

★ 

* 


*  Interim  engine  model  for  the  generic  rotary-wing  aircraft 

*  with  power  characteristics  similar  to  the  General 

*  T700-GE-701  turboshaft  engine.  The  T700  is  rated  at  a 

*  maximum  continuous  power  of  1510  shp  at  sea-level. 

*  Two  (2)  T700s  power  the  AH-64  Apache  attack  helicopter. 
****************************************************************/ 


★ 

* 

★ 

★ 


#include 

" stdio .h" 

# include 

"math .h" 

Sinclude 

"sim_dfns .h" 

# include 

"sim_macros .h" 

# include 

" sim_types .h" 

tinclude 

" libsound .h" 

(^include 

" rwa_soun_df n . h 

# include 

" rwa_meter .h" 

#include 

”rwa_cntrl .h" 

# include 

“ 1 ibmun . h " 

# include 

" failure .h" 

# include 

"libfail.h" 

/* 

*  Debug 
*/ 

macro 

#ifdef  FILEDBG 

#def ine 
#else 

P(a)  a 

#def ine 
#endif 

P{a) 

li 


/* 


Once  the  engine  or  transmission  has  been  damaged,  there 
the  engine/transmission  will  seize  due  to  too  many 
accumulating  in  the  respective  oil  system.  These  are 

12-10-90  pjm  */ 


is  a  chance  that 
icle  fragments 
secondary"  events. 


#define  DO_CFAIL  TRUE  /*  do  combat  damage  simulation  */  ^ 

#define  DO_SFAIL  TRUE  /*  do  stochastic  failure  simulation  */ 


static  REAL  engine_data [ 20 ] 
1030.55,  0.05, 

1.2,  1200.0, 

7.0,  100.0, 

0.0,  0.0, 

}  ; 


=  { 

0.05,  1031.6, 

0.16438,  2.130, 

153.8461539,  0.0, 

0.0,  0.0, 


25.0, 

34.0, 

0.0, 

0.0 


static  REAL  engine_init_data [ 10 ]  =  { 

0.0,  0.0,  0.0, 

1.0,  0.0,  0.0, 


0.0,  0.0, 

0.0,  0.0 
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}  ; 


static  int  engine_stat_data [ 10]  =  { 

0 ,  0 ,  1  < 

0,  0,  0, 

}  ; 


1, 

0, 


2, 

0 


#def ine 
#def ine 
#def ine 
#def ine 
Sdefine 
#def ine 
#def ine 
#def ine 
#def ine 
#def ine 
#def ine 
#def ine 
#def ine 


G0VERN0R_ENG INE_S  PEED_SETT ING 
G0VERN0R_P_GAIN 
G0VERN0R_I_GAIN 
MAX_ENGINE_TORQUE 
MIN_ENGINE_LOAD_TORQUE 
MAX_ENG INE_PERCENT_POWER 
ENGINE_TORQUE_INTERCEPT 
ENGINE_TORQUE_SLOPE 

nose_gearbox_ratio 

MAIN_R0T0R_GEAR_RAT I 0 
T A I L_R0T0R_GEAR_RAT I 0 
powertrain_inertia 

MAX_FUELFLOW 


engine 
engine_data [ 
engine_data [ 
engine_data [ 
engine 
engine_data [ 
engine, 
engine_data [ 
engine_data [ 
engine_data [ 
engine_data [ 
engine_data [ 
engine_data [ 


.data  [ 

1] 

2] 

3] 

data  [ 
5] 

:_data  [ 

7] 

8] 

9] 

10] 

11] 

12] 


0] 


4] 

6] 


/*  (seconds/tick)  /  (seconds /hour)  =  (hours/tick)  */ 
#define  HOURS_PER_TICK  (  DELTA_T  /  3600.0  ) 
static  REAL  hours_of_f light ; 

static  int  Biinutes_of_f light ,  old_minutes_of_f light ; 
static  BOOLEAN  engine_is_damaged,  transmission_is_damaged; 

/******  engine  noise  stuff  **♦**/ 

Sdefine  ORIGINAL  0 
#define  BOTH_DISABLED  1 

#define  CHANGE_ROTOR  2 

# define  CHANGE_ENGINE  3 

#define  CHANGE_BOTH  4 

static  int  engine_sound_type  =  CHANGE_BOTH;  ^ 

static  int  engine_oscillation [2 ] ,  rotor_osc illation [2 ] , 


#define  MIN_ROTOR_SOUND 
# define  MAX_ROTOR_SOUND 
# define  ROTOR_SOUND_RANGE 
#define  MIN_TURBINE_SOUND 
#define  MAX_TURBINE_SOUND 
#define  TURBINE_SOUND_RANGE 


105 

120 

{MAX_ROTOR_SOUND  - 
95 
126 

{ MAX_TU8B  INE_SOUND 


MIN_ROTOR_SOUND) 


-  MIN_TURBINE_SOUND) 


static  REAL  turbine_speed;  v,  ^ / 

static  REAL  engine_speed;  /*  Nose  gearbox  output  shaft  / 

static  REAL  engine_load_torque ; 

static  REAL  engine_percent_torque ; 

static  REAL  engine_drive_torque ; 

static  REAL  inain_rotor_shaf t_speed; 

static  REAL  inain_rotor_drive_torque  ; 

static  REAL  tail_rotor_shaf t_spe€d; 

static  REAL  tail_rotor_drive_torque ; 

static  REAL  powertrain_percent_shaft_speed; 

static  REAL  last_percent_shaf t_speed; 

static  REAL  last_percent_torque; 
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static  REIAL  fuel_flow; 
static  REAL  engine_power ; 
static  REAL  integrator_gain ; 
static  REAL  gov_p_gain; 
static  REAL  gov_i_gain; 

static  int  number_of_engines ;  /*  Working  */ 
static  int  engine_status ; 

I*  Flag  used  to  determine  if  the  engine  is  starting.  Sounds  for  the  engine 
and  rotors  are  more  "realistic."  Starting  engine  speed  is  0  instead  of 
GOVERNOR_ENGINE_SPEED_SETTING,  and  since  engine_power  then  maxes  out 
{causes  "torque"  to  flash)  a  check  is  done  and  temporarily  forces  the 

torque  percentage  to  be  equal  to  1 . 

11-8-89  Paul  J.  Metzger  */ 

static  int  starting_engine; 

void  engine_simul  (main_rotor_load,  tail_rotor_load,  altitude) 

REAL  main_rotor_load,  tail_rotor_load,  altitude; 

{ 

REAL  tail_rotor_engine_load; 

'  REAL  main_rotor_engine_load; 

REAL  temp_percent ; 

int  temp_sound; 

main_rotor_engine_load  =  main_rotor_load  /  MAIN_R0T0R_GEAR_RATI0; 
tail_rotor_engine _ load  =  tail_rotor _ load  /  TAIL _ R0T0R_GEAR_RATI0; 

engine_load_torque  =  main_rotor_engine_load  +  tail_rotor_engine_load; 
if  (engine_load_torque  <  MIN_ENGINE_LOAD_TORQUE) 
engine_load_torque  =  MIN_ENGINE_LOAD_TORQUE; 

engine_power  =  gov_p_gain  * 

(GOVERNOR_ENGINE_SPEED_SETTING  -  engine_speed) ; 

if  (engine_status  ==  WORKING) 

{ 

integrator_gain  +=  gov_i_gain  * 

(GOVERNOR_ENGINE_SPEED_SETTING  -  engine_speed) ; 
if  ( integrator_gain  >  0.5) 
integrator_gain  =  0.5; 
else  if  { integrator_gain  <  -0.5) 
integrator_gain  =  -0.5; 

engine_power  +=  integrator_gain; 

) 

else  /*  Damaged  */ 

{ 

integrator_gain  =  0.0; 
if  (engine_power  >  0.7) 
engine_power  =  0.7; 

} 

if  (engine_power  >  MAX_ENGINE_PERCENT_POWER) 
engine_power  =  MAX_ENGINE_PERCENT_POWER; 
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if  {engine_power  <  0.0) 
engine_power  =  0.0; 

if  {fuel_level_empty  ())  /*  Out  of  gas  */ 

{ 

engine_power  =  0.0; 
engine_speed  =  0.0; 


engine_drive_torque  =  engine_power  *  number_of_engines 

(ENGINE_TORQUE_INTERCEPT  -  ENGINE_TORQUE_SLOPE  *  engine_speed) ; 

engine_percent_torque  =  engine _ drive — torque  / 

(MAX_ENGINE_TORQUE  *  number_of_engines ) ; 

if  {engine_status  ==  WORKING) 

engine_speed  +=  (engine_drive_torque  -  engine_load_torque) 

/  POWERTRAIN_INERTIA; 

'  if  (engine_speed  <  0.0) 
engine_speed  =  0.0; 

turbine_speed  =  engine_speed  *  NOSE_GEARBOX_RATIO; 
main  rotor_shaf t_speed  =  engine_speed  /  MAIN_ROTOR_GEAR_RATIO; 
tail_rotor_shaft_speed  =  engine_speed  /  TAIL_ROTOR_GEAR_RATIO; 
powertrain_percent_shaft_speed  =  engine_speed  / 

tail_rotor_drive_torque  =  tail_rotor_load;  /*  Always  have  tail  rotor  / 
main_rotor_drive_torque  =  {engine_drive_torque  -  tail_rotor_engine_load) 
*  MAIN_ROTOR_GEAR_RATIO; 
if  {main_rotor_drive_torque  <  0.0) 
main_rotor_drive_torque  =  0.0; 


fuel_flow  =  engine_percent_torque  *  MAX_FUELFLOW ; 


if  {engine_status  ==  BROKEN)/*  crippled  condition  */ 


{ 


sound_stop_cont_sound 
sound_stop_cont_sound 
fuel_flow  *=  50.0; 


(SOUND_OF_STOP_ENGINE,  SOUND_OF_VARY_ENGINE) ; 
{SOUND_OF_STOP_ROTOR,  SOUND_OF_VARY_ROTOR) ; 

/*  fuel  lea)<  */ 


) 


if  {starting_engine) 

if  {engine_percent_torque  -  .01  <  .0001)  /*  within  a  delta  */ 

starting_engine  =  FALSE; 

else 

engine_percent_torque  =  .01; 


fuel_used_by_engine  {fuel_flow  /  3600.0  *  DELTA_T) ; 


meter_torque_set  (engine_percent_torque) ; 
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meter_rpm_set  (powertrain_percent_shaf t_speed) ; 

60)  ; 


hours_of_f 1 iQht  +-  HOURS_PER_TICK, 
minutes_of_f light  =  (int)  {hours_of_f light 
#if  DO_SFAIL  ,  ^  _ 

if  {minutes_of_f light  >  old_minutes_of_f light) 


{ 


sfail_event_occurred  {SFAIL_EVENT_MILEAGE) ; 
if  (enaine  is_damaged) 

3fail_event_occurred  (SFAIL_SECONDARY_EVENT_ENGINE) ; 
if  (transmission  is_daniaged) 

gfail_event_occurred  {SFAIL_SECONDARY_EVENT_TRANSMISSION) , 
old_minutes_of_f light  =  ininutes_of_f light; 


} 

#endif 


if  { !  fuel_level_einpty  {)) 

{ 

switch  (engine_sound_type) 

{ 

case  CHANGE_ENGINE: 

if  {abs  {powertrain_percent_shaf t_speed 

-  last_percent_shaft_speed)  >  0.025) 


{ 


/*  rotor  sounds  depend  on  RPMs 

*  (powertrain_percent_shaft_speed)  */ 
temo  oercent  =  max  (0.01,  powertrain_percent_shaf t_speed) ; 
sound^make_cont_sound  { SOUND_OF_START_ROTOR ,  SOUND_OF_VARY_ROTOR , 

SOUND_OF_STOP_ROTOR,  temp_percent ) ; 

last_percent_shaft_speed  =  powertrain_percent_shaf t_speed; 

} 

if  {abs  (engine_percent_torque  -  last_percent_torque)  >  0.025) 

^  /*  engine  sounds  depend  on  torque  (engine_percent_torque)  */ 
t-pmn  oercent  =  max  (0.01,  engine_percent_torque)  ; 

sZ£™kSont_sound  (SOUND.OF_STAET_ENGINE,  SOUND_OF_VM!Y_ENGINE, 

SOUND_OF_STOP_ENGINE,  temp_percent ) ; 
last_percent_torque  =  engine_percent_torque ; 

} 

break; 

case  ORIGINAL: 

if  (abs  (powertrain_percent_shaft_speed 

-  last_percent_shaft_speed)  >  0.025) 


{ 


/*  rotor  sounds  depend  on  RPMS 

*  (powertrain_percent_shaf t_speed)  */ 

temp_percent  =  max  (0.01,  P°«e^train_percent_shaf t_speed) ; 
sound_make_cont_sound  ( SOUND_OF_START_ROTOR ,  SOUND_OF_VARY_ROTOR , 

SOUND_OF_STOP_ROTOR,  temp_percent ) ; 
sound  make_cont_sound  (SOUND_OF_START_ENGINE,  SOUND_OF_VARY_ENGINE, 

SOUND_OF_STOP_ENGINE,  temp_percent ) ; 

last_percent_shaft_speed  =  powertrain_percent_shaf t_speed; 


) 
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break; 

case  CHANGE_BOTH: 

/*  Try  the  following,  as  per  Perc's  directions:  vary  both  the 

*  rotor  and  engine  with  torgue,  but  have  the  rotor  range  be  from 

*  105  to  120,  and  the  turbine  range  from  95  to  126. 

* 

*  The  rotor  sound  range  is  15  points  (120-105),  so  the  %  torque  is 

*  multiplied  by  15,  then  added  to  an  offset  of  105. 

* 

*  The  turbine  sound  range  is  31  points  (126-95),  so  the  %  torque  is 

*  multiplied  by  31,  then  added  to  an  offset  of  105. 

* 

*  11-17-90  PJM  */ 

if  (abs  (engine_percent_torque  -  last_percent_torque)  >  0.025) 

{ 

/*  both  sounds  depend  on  torque  */ 

temp_sound  =  (int)  (engine_percent_torque  *  ROTOR_SOUND_RANGE )  + 
MIN_ROTOR_SOUND ; 

if  (temp_sound  >  MAX_ROTOR_SOUND ) 
temp_sound  =  MAX_ROTOR_SOUND; 

/*  We  check  to  see  if  the  sounds  are  oscillating.  This  */ 

/*  event  occurs  while  at  the  extreme  torque  edges  of  */ 

/*  the  hover  hold  mode,  when  we're  trying  to  break  */ 

/*  hold.  2-15-91  PJM  */ 

if  (temp_sound  !=  rotor_oscillation[l] ) 

sound_make_arg_sound  ( SOUND_OF_VARY_ROTOR ,  temp_sound) ; 

rotor_oscillation[l]  =  rotor_oscillation[0]; 
rotor_oscillation [0 ]  =  temp_sound; 

temp_sound  =  (int)  (engine_percent_torque  * 

TURBINE_SOUND_RANGE)  +  MIN_TURBINE_SOUND; 
if  (temp_sound  >  MAX_TURBINE_SOUND) 
temp_sound  =  MAX_TURBINE_SOUND; 

if  (temp_sound  !=  engine_oscillation [ 1 ] ) 

sound_make_arg_sound  (SOUND_OF_VARY_ENGINE,  temp_sound) ; 

engine_oscillation [ 1]  =  engine_oscillation [ 0 ]  ; 
engine_oscillation[0]  =  temp_sound; 

last_percent_torque  =  engine_percent_torque; 

} 

break; 

case  CHANGE_ROTOR : 

if  (abs  ( engine_percent_torque  -  last_percent_torque)  >  0.025) 

{ 

/*  rotor  sounds  depend  on  torque  */ 

temp_sound  =  (int)  (engine_percent_torque  *  ROTOR_SOUND_RANGE )  + 

MIN_ROTOR_SOUND; 

if  (temp_sound  >  MAX_ROTOR_SOUND) 
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temp_sound  =  MAX_ROTOR_SOUND ; 
sound_make_arg_sound  ( SOUND_OF_VARY_ROTOR ,  temp_sound) ; 
sound_stop_cont_sound  {SOUND_OF_STOP_ENGINE, 

SOUND_OF_VARY_ENGINE) ; 

last_percent_torque  =  engine_percent_torque ; 

} 

break; 


case  BOTH_DISABLED: 

sound_stop_cont_sound 

sound_stop_cont_sound 

break; 

} 

) 


{ S0UND_0F_ST0  P_ENG INE ,  SOUND_OF_VARY_ENG INE ) 
{SOUND_OF_STOP_ROTOR,  S0UND_0F_VARY_R0T0R ) ; 


} 

REAL  engine_get_rotor_percent_shaf t_speed  ( ) 

return  {powertrain_percent_shaft_speed) ; 

} 

f 

void  engine_damage_engine_oil  () 

{ 

#if  DO_CFAIL 

controls_start_failure_lamp_f lashing  (MASTER_CAUTION) ; 
controls_start_failure_lamp_f lashing  (ENGINE_FAILURE) ; 
iendif 

engine_is_damaged  =  TRUE; 

} 

void  engine_repair_engine_oil  {) 

{ 

#if  DO_CFAIL 

controls_failure_lamp_of f  (ENGINE_FAILURE) ; 
engine_is_damaged  =  FALSE; 

#endif 

} 


void  engine_break_engine  {) 

{ 

engine_status  =  BROKEN; 
engine_speed  =  0.0; 
number_of_engines  =  1; 

} 

void  engine_repair_engine  {) 

{ 

engine_repair_engine_oil  (); 
engine_status  =  WORKING; 
number_of_engines  =  2; 

) 

void  engine_damage_transmission_f ilter  () 

{ 
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#if  DO_SFAIL 

controls_start_failure_lamp_f lashing  {MASTER_CAUTION) ; 
controls_start_failure_lamp_f lashing  (TRANSMISSION_FAILURE) ; 
transmission_is_damaged  =  TRUE; 

#endif 

} 

void  engine_repair_transinission_f ilter  {) 

{ 

#if  DO_SFAIL 

controls_failure_lamp_of f ' {TRANSMISSION_FAILURE) ; 
transmission_is_damaged  =  FALSE; 

#endif 

) 

void  engine_break_transmission  {) 

{ 

#if  DO_SFAIL 

engine_break_engine  ();  /*  engine  has  seized  */ 

#endif 

) 

f 

void  engine_repair_transmission  () 

{ 

#if  D0_SFAIL 

engine_repair_transmission_f ilter  () ; 
engine_repair_engine  {); 

#endif 

} 


void  engine_init  {) 

{ 

int  i  ; 

int  data_init; 
float  data_tmp; 
char  descript [80] ; 

FILE  *fp; 

P(printf ("$$$$  RWA  ENGINE  file  data  $$$$\n");); 

/*  DEFAULT  DATA  FOR  rwa_engine.c  READ  FROM  FILE  */ 

fp  =  fopen{“/sininet/data/rwa_engn.d",“r"); 
if {fp==NULL) { 

fprintf (stderr,  "Cannot  open  /siinnet/data/rwa_engn .d\n" ) ; 
exit { ) ; 

} 

rewind ( fp) ; 

/*  Read  array  data  */ 
i  =  0; 

while  (  fscanf  (fp, ''%f" ,  &data_tmp)  1=  EOF)  { 
engine_data [ i ]  =  data_tmp; 
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} 


fgets (descript,  80,  fp) ; 

P (printf ( "engine_data (%3d)  is%11.3f  %s",  i,  engine_data [ i ] , 

descript) ; ) ; 

++i; 


fclose ( fp) ;  * 

END  DEFAULT  DATA  FOR  rwa_engine.c  READ  FROM  FILE  / 

DEFAULT  INITIALIZATION  DATA  FOR  rwa_engine.c  READ  FROM  FILE 

fp  =  f open ( " / simnet /data/rw_en_in . d “ , “ r “ ) ; 

if {fp==NULL) {  . 

fprintf ( stderr ,  "Cannot  open  /simnet /data/rw_en_in . d\n  ) ; 

exit { ) ; 

} 

rewind (fp) ; 

/*  Read  array  data  */ 
i  =  0; 


while(fscanf (fp, "%f " ,  &data_tmp)  !=  EOF) { 
engine_init_data [i]  =  data_tmp; 
fgets (descript,  80,  fp) ; 

P (printf (" engine_init_data ( %3d)  is%11.3f  %s",  i, 

engine_init_data[i] ,  descript) ; ) ; 

++i; 

} 

fclose ( fp) ; 

END  DEFAULT  INITIALIZATION  DATA  FOR  rwa_engine.c  READ  FROM  FILE 
DEFAULT  STATUS  DATA  FOR  rwa_engine.c  READ  FROM  FILE 

fp  =  fopen("/simnet/data/rw_en_st.d",’’r“); 

if (fp==NULL) { 

fprintf (stderr,  "Cannot  open  /simnet/data/rw_en_st .d\n  ) ; 
exit ( ) ; 

} 


rewind (fp) ; 

/*  Read  array  data  */ 
i=0; 

while(fscanf (fp, "%d" ,  &data_init)  !=  EOF) { 
engine_stat_data [ i ]  =  data_init; 
fgets (descript,  80,  fp); 

P (printf (“ engine_stat_data ( %3d)  is%lld  %s  ,  i, 
engine_stat_data [i] ,  descript) ; ) ; 

++  i ; 

} 

fclose ( fp) ; 

END  DEFAULT  STATUS  DATA  FOR  rwa_engine.c  READ  FROM  FILE 


*/ 
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GOVERNOR_P_GAIN  ; 

GOVERNOR_I_GAIN ; 
engine_init_data [  0]; 
engine_init_data [  1]; 
engine_init_data [  2]; 
engine_init_data [  3]; 
engine_init_data [  4]; 
engine_init_data [  5] ; 
engine_init_data [  6] ; 

engine_stat_data [  0]; 
engine_stat_data [  1] ; 
engine_stat_data [  2 ] ; 
engine_stat_data [  3 ]  ; 
engine_stat_data [  4]  ; 
engine_stat_data [  5]  ; 
engine_stat_data [  6]  ; 

#if  DO_CFAIL 

fail_init_failure  {motiveOilLeak,  engine_damage_engine_oil , 

,engine_repair_engine_oil ,  NO_SELF_REPAIR,  noncritKill) ; 

,  fail_init_failure  {motiveEngineMajor,  engine_break_engine,  ^ 

engine_repair_engine,  NO_SELF_REPAIR,  mobilityKill) ; 

#endif 

#if  DO_SFAIL 

fail_init_failure  (motiveTransFluidFilter, 

eng ine_damage_transmission_f liter,  engine_repair_transmission_f liter , 
NO_SELF_REPAIR,  noncritKill); 

fall_lnlt_fallure  (motlveTransinlsslonMajor,  englne_break_transmlsslon, 
englne_repalr_transmlsslon,  NO_SELF_REPAIR,  mobilityKill) ; 

#endlf 

} 

void  englne_debug_prlnt  () 

prlntf  {“rpm  =  %f\n  rps  =  %f\n  ps  =  %f\n  etq  =  %f\n  mrt  =  %f\n  , 
power traln_percent_shaft_speed,  englne_speed, 

englne_power ,  englne_drlve_torque,  maln_rotor_drlve_torque) ; 

} 

REAL  englne_get_speed  ( ) 

{ 

return  {englne_speed) ; 

} 

void  englne_toggle_sound  () 

{ 

If  ( {englne_sound_type  -  1)  <  ORIGINAL) 
englne_sound_type  =  CHANGE_BOTH ; 
else 

eng lne_sound_type - - ; 

switch  {englne_sound_type) 

{ 


gov_p_galn  = 
gov_l_galn  = 
englne_power  = 
englne_percent_torque  = 
englne_speed  = 
lntegrator_galn  = 
last_percent_shaf t_speed  = 
last_percent_torque  = 
h6urs_of_f light  = 
mlnutes_of_fllght  = 
old_mlnutes_of_f light  = 
englne_status  = 
startlng_englne  = 
number_of_englnes  = 
englne_ls_damaged  = 
transmlsslon_ls_damaged  = 
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case  ORIGINAL: 

printf  ("Rotor:  RPM  Engine:  RPM\n"); 
break; 

case  CHANGE_ROTOR : 

printf  ("Rotor:  TORQUE  Engine:  DISABLED\n" ) ; 
break; 

case  CHANGE_ENGINE : 

printf  (“Rotor:  RPM  Engine:  TORQUE\n"); 
break; 

case  CHANGE_BOTH: 

printf  ("Rotor:  TORQUE  ‘  Engine:  TORQUE\n“); 
break ; 

case  BOTH_DISABLED : 

printf  ("Rotor:  DISABLED  Engine:  DISABLED\n “ ) ; 
break; 

} 

} 

REAL  engine_get_hours_of_f light  () 

{ 

return  (hours_of_flight) ; 

}' 

int  engine_get_minutes_of_f light  () 

{ 

return  (ininutes_of_f light )  ; 

} 
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rwa_kinemat.c  for  convenience  in  document  maintenance  and 
understanding  of  the  CSU. 
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/*  $Header:  /a3 /adst-cm/RWA/AIRNET/siinnet/vehicle/rwa/src/RCS/rwa_kinemat . c , v 

1.6  1993/01/28  23:33:00  cm-adst  Exp  $  */ 

/* 

*  $Loq:  rwa_kinemat . c , V  5 

*  Lvision  1.6  1993/01/28  23:33:00  cm-adst 

*  P.  DesMeueles ' s  changes  for  spcr  31 

*  Revision  1.5  1992/12/21  22:16:49  cm-adst 

*  R  Branson's  flight  changes.  These  changes  will  become 

*  BDS-D  1.1.1.  This  change  was  turned  over  by  C.  Swanson. 

*  Revision  1.1  1992/10/07  19:00:23  cm-adst 

*  Initial  Version 

* 

static  char  RCS_ID[]  =  /^^/RCs/™a  kinemat  c  v  1.6  1993/01/28  23:33:00 

cm/RWA/AIRNET/simnet/vehicle/rwa/src/RCS/rwa_kinem  . 

cm-adst  Exp  $"; 

/**************************************************************************^ 

★ 

^  Revisions: 

SP/CR  Number 


★ 

* 

★ 

★ 

★ 

★ 

■k 

★ 

★ 

★ 


Version 

Date 

Author 

Title 

1.2 

10/09/92 

R.  Branson 

Data  File  Initiali¬ 
zation 

1.3 

10/16/92 

R .  Branson 

Data  filenames  changed 
to  eight  characters 

1.4 

10/30/92 

R.  Branson 

Added  pathname  to  data 
directory 

1.5 

01/19/93 

P .Desmeules 

Increased  the  size  of 
fgets  to  make  sure  the 
whole  line  is  read  in. 

1.5 

03/04/93 

P.Desmeules 

Fix  value  of 

DISPLAY_SPEED_LIMIT 

31 


85 


Description  of  Modification 


/ 


■* 

*  SP/CR  No. 


★ 

★ 

★ 

★ 

★ 

★ 

★ 

*  ★ 


Hard  coded  defines  changed  to  array  element. 

Kinemat  data  array  added. 

Kinemat  initialization  array  added. 

Added  file  read  for  kinemat  data  and  kinemat  initiali 
ration  data  to  the  " veh_spec_kinematics_init 

function . 

Add--d  "/simnet/data/"  to  each  data  file  pathname. 
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*  FILE: 

*  AUTHOR: 

*  MAINTAINER: 

*  PURPOSE: 

* 

★ 

* 

*  HISTORY: 

★ 

★ 


rwa_kinemat . c 
Bryant  Col lard 
Bryant  Collard 

This  file  contains  routines  which  process 
information  generated  in  the  dynamics  and 
kinematics  software  to  generate  data  needed 
specifically  for  the  rotary  wing  aircraft. 
03/03/89  bryant :  Creation 
05/15/89  james:  Modified  for  RWA 


★ 

*  Copyright  (c)  1989  BBN  Systems  and  Technologies,  Inc. 

*  All  rights  reserved. 

* 


★ 

* 

★ 

★ 

★ 

* 

★ 

★ 

★ 

* 

•k 

★ 

★ 

* 

★ 


Sinclude 

"stdio.h" 

# include 

"math .h“ 

Sinclude 

" sim_types .h“ 

Sinclude 

"sim_dfns .h" 

Sinclude 

'‘sim_macros  .h 

Sinclude 

“libmatrix.h" 

# include 

“ librotate .h” 

Sinclude 

"vehicle .h" 

Sinclude 

"std_atm.h" 

/* 

*  Debug  macro 
*/ 

#ifdef  FILEDBG 
#define  P(a)  a 

Seise 

Idefine  P{a) 

Sendif 


Sdefine  GRAV_CONSTANT 


kinemat_data [  0] 


Sdefine  SIN_AOA_LIMIT 
tdefine  COS_AOA_LIMIT 
ftdefine  SIN_YAW_LIMIT 
fide  fine  COS_YAW_LIMIT 


kinemat_data [  1] 
kinemat_data [  2 ] 
kinemat_data (  3] 
kinemat_data [  4] 


Sdefine  DISPLAY_SPEED_LIMIT  kinemat_data [  5] 


static  VECTOR  pos_unit_vel ; 
static  VECTOR  neg_un i t_ve 1 ; 
static  REAL  sin_aoa; 
static  REAL  cos_aoa; 
static  REAL  sin_yaw; 
static  REAL  cos_yaw; 
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static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 

static 


REAL  altitude; 

REAL  body_pitch; 

REAL  body_pitch_offset; 
REAL  ve loci ty_p itch; 

REAL  roll; 

REAL  heading; 

REAL  true_airspeed; 

REAL  indicated_airspeed; 
REAL  g_force; 

REAL  vertical_speed; 

REAL  *ang_vel; 

REAL  *velocity_vector ; 
VECTOR  gravity; 

VECTOR  norm_vel; 

T_MATRIX  velocity_to_body; 


SPCR  85  -  Fix  the  value  of  DISPLAY_SPEED_LIMIT  {element  5)  from  0.1 


9.81, 

0.642787610, 

0.766044443, 

0.642787610,  0 

5.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

}  ; 

0.0, 

0.0, 

3.0, 

0.0 

REAL 

kinemat_init_ 

.data  [30]  =  { 

0.0, 

1.0, 

0.0, 

0.0, 

-1.0, 

0.0, 

0.0, 

1.0, 

0.0, 

1.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

1.0, 

0.0, 

0.0, 

0.0, 

-1.0, 

0.0, 

1.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0 

0.766044443, 


*  ROUTINE;  veh_spec_kinematics_init  * 

*  PARAMETERS:  none  * 

*  RETURNS:  none  * 

*  PURPOSE:  This  routine  initializes  vehicle  specific  * 

*  kinematics  parameters.  * 

*  * 
****************************************************************/ 


void  veh_spec_kinematics_init  {) 

{ 

/*  DEFAULT  DATA  FOR  rwa_kinemat . c  READ  FROM  FILE  */ 

int  i  ; 

float  data_tmp; 
char  descript [80]  ; 

FILE  *fp; 

P(printf ("$$$$  RWA  KINEMATICS  file  data  $$$$\n“);); 


to  5.0 
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fp  =  fopen("/sininet/data/rwa_kine.d“,  "r”)  ; 
if(fp==NULL){ 

fprintf (stderr,  "Cannot  open  /simnet/data/rwa_Kine .d\n  ); 
exit  { )  ; 

} 


rewind ( fp) ; 


/*  Read  array  data  */ 
i  =  0; 


while{fscanf (fp, "%f ",  &data_tmp)  !=EOF){ 
kinemat_data [ i ]  =  data_tmp; 

fgets {descript,  80,  fp); 

P  (printf  ( ''kineniat_data  (%3d)  is%11.3f  %s", 

descript) ; )  ; 

++  i ; 

1 


i ,  kinemat_data [ i ]  , 


f close (fp) ; 

f 

/*  END  DEFAULT  DATA  FOR  rwa_kinemat .c  READ  FROM  FILE  */ 

/*  DEFAULT  INITIALIZATION  DATA  FOR  rwa_kinemat . c  READ  FROM  FILE 

fp  =  fopen("/simnet/data/rw_ki_in.d" , "r" ) ; 

if {fp==NULL) { 

fprintf (stderr,  "Cannot  open  /simnet/data/rw_ki_in .d\n  ); 
exit { ) ; 


rewind (fp) ; 

/*  Read  array  data  */ 
i=0; 

while{fscanf  (fp,  "%f",  &data_tinp)  !=EOF){ 
kinemat_init_data [ i]  =  data_tmp; 
fgets {descript ,  80,  fp); 

P  (printf  (" kineinat_init_data  { %3d)  is%11.3f  %s",  i, 

kineinat_init_data  [  i  ]  ,  descript)  ; )  ; 

++i; 

} 


fclose ( fp) ; 

/*  END  DEFAULT  INITIALIZATION  DATA  FOR  rwa_kinemat .  c  READ  FROM  FILE 


pos_unit_vel [Y]  = 

kinemat_init_data  [ 

1] 

pos_unit_vel [Z]  = 

kineinat_init_data  [ 

2] 

neg_unit_vel [X]  = 

kinemat_init_data [ 

3] 

neg_unit_vel [Y]  = 

kinemat_init_data [ 

4] 

neg_unit_vel [Z]  = 

kinemat_init_data  [ 

5] 

sin_aoa  = 

kinemat_init_data  [ 

6] 
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cos_aoa  = 
sin_yaw  = 
cos_yaw  = 
altitude  = 
body _p itch  = 
body _p i t ch_o f f set  = 
velocity_pitch  = 
roll  = 
heading  = 
true_airspeed  = 
indicated_airspeed 
g_force  = 
vertical_speed  = 


kinemat_init_data [  7] 
kinemat_init_data [  8] 
kinemat_init_data[  9] 
kinemat_init_data [ 10 ] 
kinemat_init_data [ 11 ] 
kinemat_init_data [ 12 ] 
kinemat_init_data [ 13 ] 
kinemat_init_data ( 14 ] 
kineinat_init_data  [  15  ] 
kinemat_init_data [ 16 ] 
kinemat_init_data [ 17 ] 
kinemat_init_data [ 18 ] 
kinemat_init_data [ 19 ] 


ang_vel  =  vehicle_angular_velocity  (); 
velocity_vector  =  vehicle_velocity ( ) ; 
gravity[X]  =  kinemat_init_data [20 ] 

gravity[Y]  =  kinemat_init_data [21 ] 

gravity [Z]  =  kinemat_init_data [22 ] 

norm_vel[X]  =  kinemat_init_data [23 ] 

norm _ vel[Y]  =  kinemat init data[24] 

norm_vel[Z]  =  kinemat_init_data[25] 

mat_ident  {velocity_to_body ) ; 


.  ★ 


*  ROUTINE:  veh_spec_kinematics_simul  * 

*  PARAMETERS:  none  * 

*  RETURNS:  none  .  .  *  . 

*  PURPOSE:  This  routine  finds  vehicle  specific  kinematics  * 

*  parameters .  * 


void  veh_spec_kinematics_simul  {) 

{ 

REAL  ‘velocity; 

REAL  temp,  temp2 ; 

REAL  ‘position; 

T_MAT_PTR  body_t  o_wor 1 d ; 

position  =  rotate_get_loc  (world  (),  hull  ()); 
altitude  =  position[Z]; 
if  (altitude  <  0.0) 
altitude  =  0.0; 

/‘  velocity  =  vehicle_velocity  ();  */ 
velocity  =  velocity_vector ; 

true_airspeed  =  sqrt  (velocity [X]  ‘  velocity [X]  +  velocity [Y]  ‘  velocity [Yj 

+  velocity[Z]  ‘  velocity [Z] ) ; 

indicated_airspeed  =  true_airspeed  ‘  sqrt  (air_density  (altitude)  / 
air_density (0 . 0 ) ) ; 
if  (true_airspeed  <  E_MILLI) 

{ 

norm_ve 1 [ X ]  =  0.0; 
norm_vel [ Y ]  =  1.0; 
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norin_vel[Z]  =  0.0; 


} 

else 

{ 


norm_vel[X]  =  velocity [X]  /  true_airspeed; 
norm_vel[Y]  =  velocity [Y]  /  true_airspeed; 
norni_vel[Z]  =  velocity  [Z]  /  true_airspeed; 


if  {norm_vel [Z]  -  1.0  >  E_NANO) 

sin_aoa  =  -1.0; 
cos_aoa  =  0.0; 
sin_yaw  =0.0; 
cos_yaw  =  1.0; 

else  if  {norm_vel[Z]  +  1.0  <  E_NANO) 

( 

sin_aoa  =  1.0; 
cos_aoa  =  0.0 
sin_yaw  =  0.0 
cos_yaw  =  1.0 


} 

else 

{ 


} 


JotSloa  i  aqr^Tn^rSallXI  -  nora,.vel[X)  .  norn^vellv)  •  nor»_v,llYl) 
sin_yaw  =  norm_vel[X]  /  cos_aoa; 
cos_yaw  =  norm_vel[Y]  /  cos_aoa; 


*/ 

/* 


if  (sin_aoa  >  SIN_AOA_LIMIT) 

{ 

temp  =  COS_AOA_LIMIT ; 

velocity_to_body [1] [2]  =  -SIN_AOA_LIMIT; 

else  if  (sin_aoa  <  -SIN_AOA_LIMIT) 

{ 

temp  =  COS_AOA_LIMIT ; 

velocity_to_body [ 1 ] [2 ]  =  SIN_AOA_LIMIT, 

) 

else 

{ 

temp  =  cos_aoa; 

velocity_to_body [1] [2]  =  -sin_aoa; 


if  (cos_yaw  <  COS_YAW_LIMIT) 

^  velocity_to_body[0] [0]  =  COS_YAW_LIMIT; 

if  (sin  yaw  >  0) 

velocity_to_body [ 0 ] [ 1 ]  =  -SIN_YAW_LIMIT , 

^^^%elocity_to_body[01  [1]  =  SIN_YAW_LIMIT; 
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else 

{ 

*/ 

velocity_to_body [ 0 ] [ 0 ]  =  cos_yaw; 
velocity_to_body [0] [1]  =  -sin_yaw; 

/* 

} 

*/ 

velocity_to_body [0] [2]  =  0.0; 

velocity_to_body [1] [0]  =  -velocity_to_body [ 0 ] [ 1 ]  *  temp; 

velocity_to_body[l] [1]  =  ■velocity_to_body [0] [0]  *  temp; 

velocity_to_body[2] [0]  =  velocity_to_body [ 1 ] [2 ]  *  velocity_to_body [ 0 ] [ 1 ] 

velocity_to_body [2] [1]  =  -velocity_to_body [ 1] [2 ]  *  velocity_to_body [ 0 ] [ 0 ] 
velocity_to_body [2] [2]  =  velocity_to_body [ 1 ] [ 1 ]  *  velocity_to_body [0 ] [ 0 ] 

velocity_to_body [1] [0]  *  velocity_to_body [ 0 ] [ 1 ] ; 

ang_vel  =  vehicle_angular_velocity  (); 
body_to_world  =  rotate_get_mat  (hull  (),  world  {)); 
gravity[X]  =  body_to_world[0] [2] ; 
gravity[Y]  =  body_to_world [ 1] [2 1 ; 
gravity[Z]  =  body_to_world[2] [2] ; 

g_force  =  gravity [Z]  +  {true_airspeed  *  ang_vel[X]  /  GRAV_CONSTANT) ; 

I  vertical_speed  =  vec_dot_prod  (norm_vel,  gravity); 
if  ( true_airspeed  >=  DISPLAY_SPEED_LIMIT) 

velocity_pitch  =  asin  {vertical_speed) ; 

else 

velocity_pitch  =  0.0; 
vertical_speed  *=  true_airspeed; 
body_pitch  =  asin  (body_to_world[l] [2] ) ; 
gravity [X]  =  -gravity [X]; 
gravity[Y]  =  -gravity[Y]; 
gravity [Z]  =  -gravity[Z]; 

temp  =  sqrt  {body_to_world [ 1] [0]  *  body_to_world [1] [0]  + 
body_to_wor Id [ 1 ] [ 1 ]  *  body_to_wor Id [ 1 ] [ 1 ] ) ; 
if  (temp  <  E_NAN0) 

{ 

roll  =  0.0; 
heading  =  0.0; 

} 

else 

{ 

temp2  =  {body_to_world[0] [0]  *  body_to_world[l] [1]  - 

body_to_world[0] [1]  *  body_to_world [1 ] [ 0 ] )  /  temp; 
if  {temp2  >  1.0)  temp2  =  1.0; 
roll  =  acos  (temp2); 

if  {body_to_world[l] [1]  *  body_to_world[2] [0]- 

body_to_wor Id [ 1 ] [ 0 )  *  body_to_world[2] [1]  <  0.0) 
roll  =  -roll; 

if  {body_to_world[l] [0]  >=  0.0) 

heading  =  acos  {body_to_world [ 1 ] [1]  /  temp) ; 

else 

heading  =  acos  (-body_to_world[l] [1]  /  temp)  +  PI; 

) 

/*  NO  METERS  FOR  NOW 

meter_g_force_set  {g_force) ; 
meter_vertical_speed_set  (vertical_speed) ; 


-D-8- 


Reference# W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


APPENDIX  D  -  rwa_kinemat.c 

if  {true_airspeed  >=  DISPLAY_SPEED_LIMIT) 

meter_send_aero_data  (rad_to_deg  (body_pitch) ,  rad. 
'  ]fad_to_d©g  (heading)  ,  asin  {sin_aoa)  ,  asin 
indicated_airspeed,  altitude,  g_force) ; 

else 

nieter_send_aero_data  (0.0,  0.0, 

rad_to_deg  (heading),  0.0,  0.0, 
indicated_airspeed,  altitude,  g_force) ; 

*/ 

} 

REAL  kinematics_get_aoa  () 

return  (asin  (-velocitY_to_body [1] [2] ) )  ; 

} 

REAL  ]cineinatics_get_yaw  () 

return  (asin  (-velocity_to_body [0] [1] ) ) ; 

} 

r£AL  kinematics_get_altitude  () 

{ 

return  (altitude); 

} 

REAL  kinematics_get_body_pitch  () 

return  (body_pitch  +  body_pitch_offset) ; 

} 

REAL  kinematics_get_velocity_pitch  () 

{ 

return  (velocity_pitch) ; 

} 

REAL  kinematics_get_roll  () 

{ 

return  (roll) ; 

) 

REAL  kinematics_get_heading  () 

{ 

return  (heading) ; 

) 

REAL  kinematics_get_true_airspeed  () 

{ 

return  (true_airspeed) ; 

} 

REAL  kineinatics_get_indicated_airspeed  () 

{ 

return  ( indicated_airspeed) ; 

) 


to_deg  (roll), 
(sin_yaw) , 
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REAL  kineinatics_get_g_force  () 

{ 

return  {g_force) ; 

) 

REAL  kinematics_get_vertical_speed  {) 

{ 

return  (vertical_speed) ; 

} 

REAL  *kinematics_get_gravity_vector  {) 

{ 

return  (gravity) ; 

} 

REAL  *kinematics_get_linear_velocity_vector ( ) 

{ 

return  {velocity_vector) ; 

) 

REAL  *kinematics_get_normalized_velocity_vector  () 

{ 

if  ( true_airspeed  >  DISPLAY_SPEED_LIMIT) 
return  (norm_vel) ; 
else  if  {norm_vel[Y]  >=0.0) 
return  (pos_unit_vel) ; 

else 

return  {neg_unit_vel ) ; 

} 

REAL  *kineinatics_get_angular_velocity_vector  {) 

{ 

return  (ang_vel) ; 

} 

T_MAT_PTR  kinematics_get_velocity_to_body  {) 

{ 

return  (velocity_to_body ) ; 

) 
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The  following  appendix  contains  the  source  code  listing  for 
miss  adat.c  for  convenience  in  document  maintenance  and 
understanding  of  the  CSU. 


t 
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/*  $Header :  /a3/adst-cm/RWA/AIRNET/simnet /vehicle/ libsrc/libmissile/RCS/miss_ada 

t.c,v  1.4  1993/01/28  23:22:08  cm-adst  Exp  $  */ 

/* 

*  $Log:  miss_adat .c, V  $ 

*  Revision  1.4  1993/01/28  23:22:08  cm-adst 

*  P.DesMeules  changes  for  spcr  31 

* 

*  Revision  1.3  1993/01/06  21:12:09  cm-adst 

*  R. Branson's  changes  for  weapons  model. 

* 

*  Revision  1.1  1992/09/30  16:39:52  cm-adst 

*  Initial  Version 

* 

*/ 

static  char  RCS_ID[]  =  "$Header:  /a3/adst-cm/RWA/AIRNET/simnet/vehicle/libsrc/li 
bmissile/RCS/miss_adat.c,v  1.4  1993/01/28  23:22:08  cm-adst  Exp  $"; 


★ 

*  Revisions: 

★ 


*  f 

* 

Version 

Date 

Author 

Title  SP/CR 

Number 

★ 

★ 

1.2 

10/23/92 

R. 

,  Branson 

Data  File  Initiali¬ 

■k 

zation 

★ 

1.3 

10/30/92 

R. 

,  Branson 

Added  pathname  to  data 

★ 

directory 

★ 

1.4 

11/25/92 

R. 

.  Branson 

Changed  %i  to  %d 

it 

1.5 

01/19/93 

P. 

,  Desmeules 

Increased  the  size  of  the 

31 

* 

fgets  to  make  sure  the 

★ 

whole  line  is  read  in. 

/***************************************************************************** 

★ 

*  SP/CR  No.  Description  of  Modification 

★  _ _ _ 


★ 

★ 

★ 

★ 

★ 

★ 

★ 

★ 

* 

★ 

★ 


Hard  coded  defines  changed  to  array  elements. 

Characteristics/parameter  data  array  added. 

Engine  initialization  data  array  added. 

Degree  of  polynomial  data  array  added. 

Added  file  reads  for  ADAT  characteristics/ 

parameters,  burn  speed  coefficients,  coast  speed 
coefficients,  burn  turn  coefficients,  coast  turn 
coefficients,  and  temporal  bias  coefficients. 

Added  " /simnet/data/ "  to  each  data  file  pathname. 


★ 


★ 
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*  FILE: 

*  AUTHOR: 

*  MAINTAINER: 

*  PURPOSE: 

* 

* 

*  HISTORY: 

★ 

* 


miss_adat . c 
Bryant  Collard 
Bryant  Collard 

This  file  contains  routines  which  fly  out  a 
missile  with  the  characteristics  of  a  ADAT 
missile . 

06/28/89  bryant:  Creation 
08/06/90  bryant:  NIU  librva  modifications. 


★ 

*  Copyright  (c)  1989  BBN  Systems  and  Technologies,  Inc. 

*  All  rights  reserved. 

* 


★ 

★ 

* 

★ 

* 

★ 

★ 

★ 

* 

★ 

★ 

ic 

* 


# include 

"stdio .h" 

#include 

“math.h" 

# include 

"sim_types .h" 

# include 

“sim_dfns .h" 

# include 

"basic .h" 

#tnclude 

"mun_type .h" 

# include 

" 1 ibmap . h " 

#include 

“ libmatrix.h" 

S include 

"miss_adat .h" 

# include 

" libmiss_dfn .h 

# include 

" libmiss_loc .h 

/* 

*  Debug  macro 
*/ 

#ifdef  FILEDBG 
#define  P{a)  a 

#else 

Sdefine  P{a) 
iendif 


/*/ 

*  Define  missile  characteristics. 
/*/ 


#define  ADAT_BURNOUT_TIME 
#define  ADAT_MAX_FLIGHT_TIME 
ttdefine  INVEST_DIST_SQ 
#define  HELO_FUZE_DIST_SQ 
#define  AIR_FUZE_DIST_SQ 
ftdefine  ADAT_TEMP_BIAS_TIME 
idefine  CLOSE_RANGE 


adat_miss_char [  0] 
adat_miss_char [  1] 
adat_miss_char [  2] 
adat_miss_char [  3] 
adat_miss_char [  4] 
adat_miss_char [  5] 
adat_miss_char [  6] 


/*/ 

*  Define  the  states  the  _ADAT_MISSILE_  can  be  in. 
/*/ 
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# define  ADAT_FREE  0 
ttdefine  ADAT_GUIDE  .1 
ftdefine  ADAT_UNGUIDE  2 
Sdefine  ADAT_CLOSE  3 
# define  ADAT_H0T  4 


/*  No  missile  assigned.  */ 

/*  Missile  flying  and  guided.  */ 

/*  Missile  flying  but  unguided.  */  ^ 

/*  Missile  flying  against  a  close  target.  */ 
/*  Missile  fired  without  cooling.  */ 


The  following  terms  set  the  order  of  the  polynomials 
the  speed  or  cosine  of  the  maximum  allowed  turn  rate 
at  any  point  in  time. 


used  to  determine 
of  the  missile 


#define  ADAT_BURN_SPEED_DEG 
# define  ADAT_COAST_SPEED_DEG 
fdefine  ADAT_BURN_TURN_DEG 
# de f ine  ADAT_COAST_TURN_DEG 
ftdefine  ADAT_TEMP_BIAS_DEG 


adat_miss_poly_deg [  0 ] 
adat_miss_poly_deg [  1] 
adat_miss_poly_deg [  2] 
adat_miss_poly_deg[  3] 
adat_miss_poly_deg [  4] 


*  ADAT  missile  characteristic  parameters 
/*/ 


initialized  to  default  values. 


static  REAL  adat_miss_char [ 10 ]  = 


{ 

48.0, 

300.00, 

90000.0, 

49.0, 

196.0, 

60.0, 

2200.0, 

0.0, 

0.0, 

0.0 

); 


/*  ticks  {3.2  sec)  */ 
/*  ticks  (20.0  sec)  */ 
/*  (300  m)  **  2  */ 

/*  (7  m)  **  2  */ 

/*  (14  m)  **  2  */ 

/*  ticks  (4.0  sec)  *! 
/*  close  range*/ 


' *  The  following  are  the  default  values  of  the  degree  of  polynomials. 
/*/ 


static 

{ 

2, 

4, 
3, 

5, 

4 


int  adat_miss_poly_deg [5]  = 

/*  Speed  before  motor  burnout.  */ 

/*  Speed  after  motor  burnout.  */ 

/*  Cosine  of  max  turn  before  burnout.  */ 
/*  Cosine  of  max  turn  after  burnout.  */ 
/*  Temporial  bias.  */ 


^  *  Coefficients  for  the  speed  polynomial  before  motor  burnout 
/*/ 

static  REAL  adat_burn_speed_coefE [ 10 ]  = 

{ 
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2.296, 

0.72990856, 

0.013310932, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0 


/*  a_0  -  m/tick  */ 

/*  a_l  -  m/tick**2  */ 

/*  a_2  -  m/tick**3  */ 


Coefficients  for  the  speed  polynomial  after  motor  burnout. 


static  REAL  adat_coast_speed_coef f [ 10 ]  - 

(  ..  . 


105.52162, 

-1.0157285, 

5.6124330e-3, 

-1.6262608e-5, 

1.8991982e-8, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0 


/*  a_0  -  m/tick  */ 
/*  a_l  -  m/tick**2 
/*  a_2  -  m/tick**3 
/*  a_3  -  m/tick**4 
/*  a_4  -  m/tick**5 


Coefficients  for  the  cosine  of  max  turn  polynomial  before  motor  burnout 

/*/ 

static  REAL  adat_burn_turn_coef f [10]  = 

[  .  , _ *  / 


0.999993, 
-6.2386917e-7, 
1.6146426e-7, 
-9 .720142e-7, 
0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0 


/*  a_0  -  cos (rad) /tick  */ 

/*  a_l  -  cos(rad)/tick**2  */ 
/*  a_2  -  cos(rad)/tick**3  */ 
/*  a_3  -  cos{rad)/tick**4  */ 


Coefficients  for  the  cosine  of  max  turn  polynomial  after  motor  burnout 


static  REAL  adat_coast_turn_coef f [10]  = 


0.99753111, 


/*  a_0  -  cos (rad) /tick  */ 
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5.5817986e-5,  /* 

-5.1276276e-7,  /* 

2 .2388593e-9,  /* 

-5.1964622e-12,  /* 

4.5499104e-15,  /* 

0.0, 

0.0, 

0.0, 

0.0 

}; 


a_l  -  cos (rad) /tick**2  */ 
a_2  -  cos{rad)/tick**3  */ 
a_3  -  cos (rad) /tick**4  */ 
a_4  -  cos (rad) /tick**5  */ 
a_5  -  cos (rad) /tick**6  */ 


II'  ,  .  , 

*  Coefficients  for  the  temporial  bias  polynomial. 

/*/ 


static  REAL  adat_temp_bias_coef f [ 10 ]  = 


{ 

5.3105657e-2, 
7 .1795817e-2, 
1.8084646e-2, 
-6.0083762e-4, 
<  4.6761091e-6, 


/*  a_0  -  m  */ 

/*  a_l  -  m/tick  */ 

/*  a_2  -  m/tick**2  */ 

/*  a_3  -  m/tick**3  */ 

/*  a_4  -  m/tick**4  */ 


0.0, 

0.0, 

0.0, 

0.0, 


0.0 


}; 


/*/ 

*  The  following  arrays  are  used  to  give  the  missile  the  proper  superelevation 

*  at  launch  time.  Two  are  required  to  deal  with  launches  off  either  side 

*  of  the  turret. 

/*/ 


static  T_MATRIX  tube_C_sight_lef t ; 
static  T_MATRIX  tube_C_sight_right ; 


*  Memory  for  the  missiles  is  declared  in  vehicle  specific  code.  During 

*  initialization,'  a  pointer  is  assigned  to  this  memory  then  some  memory 

*  issues  are  dealt  with  in  this  module. 

/*/ 

static  ADAT_MISSILE  *adat_array;  /*  A  pointer  to  missile  memory.  */ 

static  int  num_adats;  /*  The  number  of  defined  missiles.  */ 

/*/ 

*  Declare  static  functions. 

/*/ 

/*  static  void  missile_adat_f ly  ( ) ;  **  made  external  */ 
static  void  missile_adat_stop  (); 
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,i,*i,ir****************  ******************************************** 

★ 

★ 

*  ROUTINE:  missile_adat_init  _  *  ^ 

*  PARAMETERS:  missile_array  -  A  pointer  to  an  array  of 

*  ADAT  missiles  defined  in  * 

*  vehicle  specific  code.  * 

*  num_missiles  -  The  number  missiles  defined  in 

*  _missile_array_.  * 

*  RETURNS:  none  ^ 

*  PURPOSE:  This  routine  copies  the  parameters  into 

*  variables  static  to  this  module  and  initializes  * 

*  the  state  of  all  the  missiles.  It  also  * 

*  initializes  the  proximity  fuze.  * 

★ 

!***************************************************************/ 


void  missile_adat_init  (missile_array,  num_missiles ) 

ADAT_MISSILE  missile_array [ ] ; 
int  num_missiles ; 

int  i;  /*  A  counter.  */  .  . 

*  REAL  mag;  /*  Used  to  generate  tube  to  sight  matricies.  / 

int  data_tmp_int ; 
float  data_tmp; 
char  descript [ 80 ] ; 

FILE  *fp; 

P{printf  ( "$$$$  ADAT  missile  file  data  $$$$\n'');); 

/*  DEFAULT  CHARACTERISTICS  DATA  FOR  miss_adat.c  READ  FROM  FILE 
fp  =  fopen ( “ /simnet/data/ms_ad_ch.d" , "r" ) ; 

if  {fp  ==NULL)  {  ,  V  UN  . 

fprintf (stderr,  "Cannot  open  /simnet/data/ms_ad_cn.a\n 

exit ( ) ; 

) 


rewind { fp) ; 

/*  Read  array  data  */ 
i=0; 

while{fscanf  (fp,  "%f'',  &data_tmp)  !=  EOF)  { 
adat_miss_char[i]  =  data_tmp; 
fgets (descript,  80,  fp); 

P (printf { "adat_miss_char (%3d)  is%11.3f  %s",  i, 

adat_miss_char[ i] ,  descript) ; ) ; 

++i; 

} 


*/ 


fclos©(fp) / 

/*  END  DEFAULT  CHARACTERISTICS  DATA  FOR  miss_adat.c  READ  FROM  FILE 
/*  DEFAULT  BURN  SPEED  DATA  FOR  miss_adat.c  READ  FROM  FILE 

fp  =  fopen {" /simnet/data/ms_ad_bs -d" , "r" ) ; 

if (fp==NULL) { 
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fprintf (stderr,  "Cannot  open  /simnet/data/ins_ad_bs .d\n" ) ; 
exit  { )  ; 


rewind ( fp) ; 

/*  Read  degree  of  polynomial  */ 


fscanf  {fp,  ''%d",  &data_tmp_int)  ; 

ADAT_BURN_SPEED_DEG  =  data_tmp_int ; 
fgets (descript,  80,  fp); 

P (printf ( "adat_miss_poly_deg (0 )  is%3d  %s", 
ADAT_BURN_SPEED_DEG,  descript) ; ) ; 

/*  Read  array  data  */ 
i=0; 

while(fscanf (fp, “%f“,  &data_tmp)  !=EOF){ 
adat_burn_speed_coef f [ i ]  =  data_tmp; 

fgets {descript,  80,  fp); 

P (printf { "adat_burn_speed_coef f ( %3d)  is%11.3f  %s",  i, 

adat_burn_speed_coef f [i] ,  descript) ; ) ; 

++i; 

} 


fclose { fp) ; 

END  DEFAULT  BURN  SPEED  DATA  FOR  miss_adat.c 


READ  FROM  FILE 


*/ 


/*  DEFAULT  COAST  SPEED  DATA  FOR  miss_adat.c  READ  FROM  FILE  */ 

fp  =  fopen{'7simnet/data/ms_ad_cs.d", "r") ; 
if (fp==NULL) { 

fprintf (stderr,  "Cannot  open  /simnet/data/ms_ad_cs .d\n  ); 
exit ( ) ; 

) 


rewind(fp); 

/*  Read  degree  of  polynomial  */ 

fscanf  (fp,  "%d",  Scdata_tmp_int )  ; 

ADAT_COAST_SPEED_DEG  =  data_tmp_int; 
fgets {descript,  80,  fp) ; 

P(printf { "adat_miss_poly_deg{l)  is%3d  %s", 
ADAT_COAST_SPEED_DEG,  descript) ; ) ; 

/*  Read  array  data  */ 

i  =  0; 

while (fscanf (fp, "%f" ,  &data_tmp)  !=EOF){ 

adat_coast_speed_coef f [i]  =  data_tmp; 
fgets {descript,  80,  fp); 

P (printf ( "adat_coast_speed_coef f (%3d)  is%11.3f  %s",  i, 

adat_coast_speed_coef f [ i ] ,  descript) ; ) ; 

++i; 

} 
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fclose ( fp) ;  ^ 

/*  END  DEFAULT  COAST  SPEED  DATA  FOR  miss_adat.c  READ  FROM  FILE  / 

/*  DEFAULT  BURN  TURN  DATA  FOR  miss_adat.c  READ  FROM  FILE  */ 

fp  =  fopen{"/simnet/data/ms_ad_bt.d”, “r") ; 

if {fp==NULL) {  j  .V 

fprintf {stderr ,  “Cannot  open  /simnet/data/ms_ad_bt . d\n  ); 

exit { ) ; 

} 


rewind ( fp) ; 

/*  Read  degree  of  polynomial  */ 

fscanf  (fp,  ''%d",  &data_tmp_int)  ; 
ADAT_BURN_TURN_DEG  =  data_tmp_int; 
fgets (descript,  80,  fp); 

P  (printf  ( “adat_miss_polY_deg  (2 )  is%3d  %s'', 
ADAT_BURN_TURN_DEG,  descript) ; ) ; 


/*  Read  array  data  */ 
i=0; 

while(fscanf (fp, "%f " ,  &data_tmp)  !=EOF){ 
adat_burn_turn_coeff [i]  =  data_tmp; 
fgets (descript,  80,  fp); 

P (printf (“adat_burn_turn_coeff(%3d)  is%11.3f  %s",  i, 
adat_burn_turn_coef f [ i] ,  descript) ; ) ; 

++i; 

} 


fclose ( fp) ; 

/*  END  DEFAULT  BURN  TURN  DATA  FOR  miss_adat.c  READ  FROM  FILE 


*/ 


/*  DEFAULT  COAST  TURN  DATA  FOR  iniss_adat.c  READ  FROM  FILE  */ 

fp  =  fopen ( " /simnet/data/ms_ad_ct .d” , "r" ) ; 

if  (fp==NULL)  {  „  ..V 

fprintf (stderr,  "Cannot  open  /simnet/data/ms_ad_ct .d\n  ) ; 

exit ( ) ; 

} 


rewind ( fp) ; 

/*  Read  degree  of  polynomial  */ 

fscanf (fp, "%d",  &data_tmp_int) ; 
ADAT_COAST_TURN_DEG  =  data_tmp_int ; 
fgets (descript,  80,  fp); 

P (printf ( "adat_miss_poly_deg (3 )  is%3d  %s", 
ADAT_COAST_TURN_DEG,  descript) ; ) ; 

/*  Read  array  data  */ 

i  =  0; 
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while(fscanf  (fp,  &data_tmp)  !=EOF){ 

adat_coast_turn_coef  f  [  i]  =  data_tnip; 
fgets (descript,  80,  fp); 

P  (printf  ( ''adat_coast_turn_coef  f  (%3d)  is%11.3f  %s",  i, 

adat_coast_turn_coef f [ i ] ,  descript) ; ) ; 

++i; 

} 


f close ( fp) ;  ^ 

/*  END  DEFAULT  COAST  TURN  DATA  FOR  miss_adat.c  READ  FROM  FILE  / 

/*  DEFAULT  TEMP  BIAS  DATA  FOR  miss_adat.c  READ  FROM  FILE  */ 

fp  =  f open  { " /s imnet /data/nis_ad_tb . d" ,  “ r  “ )  ; 

if (fp==NULL) { 

fprintf  (stderr,  "Cannot  open  /siiiinet/data/itis_ad_tb.d\n'' )  ; 
exit ( ) ; 

} 


rewind (fp) ; 

/*  Read  degree  of  polynomial  */ 

fscanf (fp, "%d",  &data_tmp_int) ; 

ADAT_TEMP_BIAS_DEG  =  data_tmp_int; 
fgets (descript,  80,  fp) ; 

P(printf ( “adat_miss_poly_deg (4)  is%3d  %s“, 
ADAT_TEMP_BIAS_DEG,  descript) ; ) ; 

/*  Read  array  data  */ 

i=0; 

while(fscanf (fp, "%f",  &data_tmp)  !=EOF){ 
adat_temp_bias_coe  f  f [ i ]  =  data_tmp ; 
fgets (descript,  80,  fp); 

P (printf ( ”adat_temp_bias_coef f {%3d)  is%11.3f  %s“,  i, 

adat_temp_bias_coef f [i] ,  descript) ; ) ; 

++i; 

} 


fclose(fp); 

END  DEFAULT  TEMP  BIAS  DATA  FOR  miss_adat.c  READ  FROM  FILE 


*/ 


num_adats  =  num_missiles ; 

adat_array  =  missile_array ; 

for  (i  =  0;  i  <  num_missiles;  i++) 

{ 

adat_array [i] .mptr. state  =  ADAT_FREE; 

adat_array [ i ] . mptr .max_f light_time  =  ADAT_MAX_FLIGHT_TIME, 
adat_array[i] .mptr. max_turn_direct ions  =  1; 

} 

/*/ 

*  Initialize  the  proximity  fuze. 

/*/ 

missile_fuze_prox_init  {); 

/*/ 
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*  Initialize  the  tube  to  sight  transformation  matricies. 

/*/ 

mag  =  sqrt  (adat_burn_speed_coef f [0]  *  adat_burn_speed_coeff [0]  + 

2.0  *  adat_temp_bias_coef f [0]  *  adat_temp_bias_coef f [ 0 ] ) ; 

tube_C_sight_right [1] [0]  =  adat_temp_bias_coeff [0]  /  mag; 
tube_C_sight_right [1] [1]  =  adat_burn_speed_coeff[0]  /mag; 
tube_C_sight_right[l] [2]  =  adat_temp_bias_coeff [0]  /  mag; 
mag  =  sqrt  {tube_C_sight_right [1] [0]  *  tube_C_sight_right [ 1 ] [ 0 ]  + 
tube_C_sight_right [1] [1]  *  tube_C_sight_right[l][l]); 
tube_C_sight_right[0] [0]  =  tube_C_sight_right [1] [1]  /  mag; 
tube_C_sight_right[0] [1]  =  -tube_C_sight_right [ 1 ] [ 0 ]  /mag; 
tube_C_sight_right [ 0 ]  [2  ]  =  0.0; 

tube_C_sight_right[2] [0]  =  tube_C_sight_right [ 1 ] [2 ]  * 

tube_C_sight_right [0] [1]; 

tube_C_sight_right[2] [1]  =  -tube_C_sight_right [ 1 ] [2 ]  * 
tube_C_sight_right [0] [0]; 
tube_C_sight_right [2 ] [2 ]  =  mag; 

mat_copy  {tube_C_sight_right,  tube_C_sight_left) ; 
tube_C_sight_left(0] [1]  =  -tube_C_sight_left [0] [1] ; 
tube_C_sight_left[l] [0]  =  -tube_C_sight_left[l][0]; 

tube_C_sight_left[2] [0]  =  -tube_C_sight_left [2] [0] ; 

}' 

int  missile_adat_is_free {  missile  ) 
int  missile; 

return{  {adat_array [missile] .mptr . state  ==  ADAT_FREE  )); 


ROUTINE:  missile_adat_f ire  * 

PARAMETERS:  aptr  -  A  pointer  to  the  ADAT  missile  to  be 

fired.  * 

target_type  -  The  missile  can  be  set  for  three  * 
types  of  targets  by  the  launching  * 
vehicle.  This  variable  stores  * 
the  setting.  * 

launch_point  -  The  location  in  world  * 

coordinates  that  the  missile  is  * 
launched  from.  * 

loc_sight_to_world  -  The  sight  to  world  * 

transformation  matrix  used  * 
only  in  this  routine.  * 

launch_speed  -  The  speed  of  the  launch  * 

platform  (assumed  to  be  in  the  * 
direction  of  the  missile) .  * 
range_to_intercept  -  Range  to  intercept.  * 
tube  -  The  tube  the  missile  was  launched  from.  * 
target_vehicle_id  -  The  vehicle  ID  of  the  * 

target  (if  any) .  * 

RETURNS:  TRUE  if  successful,  FALSE  if  not.  * 

PURPOSE:  This  routine  performs  the  functions  * 

specifically  related  to  the  firing  of  a  ADAT  * 


-E-11- 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


APPENDIX  E  -  miss_adat.c 


★ 


missile . 


★ 

* 


int  missile_adat_fire  (aptr,  target_type, 

launch_speed ,  range_to _ intercept, 

ADAT_MISSILE  *aptr; 
int  target_type; ^ 

VECTOR  launch_point ; 

T_MATRIX  loc_sight_to_world; 

REAL  launch_speed; 

REAL  range_to_intercept ; 
int  tube; 

VehiclelD  *target_vehicle_id; 


launch_point ,  loc_sight_to_world, 
tube,  target_vehicle_id) 


int  i  ; 

MISSILE  *mptr; 

int  comm_target_type; 


/*  A  counter. 
/*  Pointer  to 
pointed  at 
/*  Indication 


the  particular  generic  missile 
by  _aptr_.  */ 

of  whether  target  is  known.  */ 


/*/ 

★ 

/*/ 


/*/ 


Find  _mptr_  and  _target_id_. 
mptr  =  & {aptr->mptr) ; 

if  {target_vehicle_id  ==  0)  .  _ 

aptr->target_vehicle_id .vehicle  =  vehicleirrelevan  , 

©Is© 

aptr->target_vehicle_id  =  *target_vehicle_id; 

Set  the  initial  time,  location,  orientation,  and  speed  of  the  generic 


*  missile. 


mptr->time  =0.0; 

vec_copy  {launch_point,  mptr->location) ; 
if  (range_to_intercept  <  CLOSE_RANGE) 

mat_copy  ( loc_sight_to_world,  mptr->orientation) ; 

else 

^  if  (((tube  /  2)  *  2)  ==  tube)  .  .  n.., 

mat_mat_mul  (tube_C_sight_left,  loc_sight_to_world, 
mptr->orientation) ; 

^^^^mat_mat_mul (tube_C_sight_right,  loc_sight_to_world, 
mptr->orientation) ; 


/*/ 


mptr->speed  =  missile_util_eval_poly 
adat_burn_speed_coef f ,  0.0)  + 

mptr->init_speed  =  launch_speed; 


( ADAT_BURN_S  PEED_DEG , 
launch_speed; 


Indicate  that  the  proximity  fuze  has  no  vehicles  it  is  tracking 


/*/ 

aptr->pptr  =  NULL; 

' *  Set  fuze  distance  and  fuze  target  according  to  missile  target 
*  setting.  Set  network  variables. 

/*/ 
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switch  (target_type) 

{ 

case  ADAT_TGT_GND : 

aptr->fuze_dist_sq  =  0.0; 

aptr->target_flag  =  PROX_FUZE_ON_NO_VEH  ; 
break; 

case  ADAT_TGT_HELO : 

aptr->fuze_dist_sq  =  HELO_FUZE_DIST_SQ ; 

if  (aptr->target_vehicle_id .vehicle  ==  vehicleirrelevant) 
aptr->target_f  lag  =  PROX_FUZE_ON_ALL_VEH  ; 

else 

aptr->target_f  lag  =  PROX_FUZE_ON_ONE_VEH ; 
break ; 

case  ■  ADAT_TGT_AIR : 

aptr->fuze_dist_sq  =  AIR_FUZE_DIST_SQ; 

if  {aptr->target_vehicle_id .vehicle  ==  vehicleirrelevant) 
aptr->target_f  lag  =  PROX_FUZE_ON_ALL_VEH ; 

aptr->target_f  lag  =  PROX_FUZE_ON_ONE_VEH ; 
break ; 
default : 

'  aptr->fuze_dist_sq  =  0.0; 

aptr->target_f  lag  =  PROX_FUZE_ON_NO_VEH  ; 

printf  {“MISS_ADAT:  Unknown  target  type  %d\n",  target_type) ; 
break; 

if  {aptr->target_vehicle_id. vehicle  ==  vehicleirrelevant) 
conira_target_type  =  targetUnkncwn; 

else 

conun_target_type  =  targetlsVehicle; 

/  *  /  • 

*  Tell  the ‘rest  of  the  world  about  the  firing  of  the  missile.  If  this 

*  cannot  be  done,  return  FALSE. 


/*/ 


if 


{ !missile_util_comm_fire_missile  (mptr,  MSL_TYPE_MISSILE, 

inap_get_ammo_entry_from_n€twork_type  (munition_US_ADATS)  , 

inunition_US_ADATS,  munitiai_US_ADATS,  &  (aptr->target_vehicle_i  ) 
comm_target_type,  objectlnrelevant ,  tube)) 
return  (FALSE) ; 


*  If  all  was  successful,  put  any  flying  missiles  in  an  unguided  state 

*  and  put  this  missile  in  a  guided  ^ate. 

1*1 

for  (i  =  ' i  <  num_adats;  i++) 

if  {  {adat_array[i]  .mptr. state  ==  ADAT_GUIDE)  II 

(adat_array [ i] .mptr .state  ==  ADAT_CLOSE) ) 
adat_array [ i ] .mptr . state  =  ADAT_UNGUIDE; 

if  (range_to_intercept  <  CLOSE_RAKIE) 
mptr->state  =  ADAT_CLOSE; 

else 

mptr->state  =  ADAT_GUIDE; 
return  (TRUE) ; 

} 
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/**************************************************************** 

'  ★ 

★ 

*  ROUTINE:  missile_adat_f ly_missiles  .  ■  * 

*  PARAMETERS:  sight_location  -  The  location  in  world 

*  coordinates  of  the  gunner’s  * 

*  sight.  * 

*  loc_sight_to_world  -  The  sight  to  world 

*  transformation  matrix  used  * 

*  only  in  this  routine.  * 

*  veh_list  -  Vehicle  list  ID. 

*  RETURNS:  none  .  .  *  * 

*  PURPOSE:  This  routine  flies  out  all  missiles  in  a 

*  flying  state.  ^ 

****************************************************************/ 

void  missile_adat_fly_missiles  (sight_location,  loc_sight_to_world,  veh_list] 
VECTOR  sight_location; 

T_MATRIX  loc_sight_to_world; 
int  veh_list; 

{' 

int  i;  /*  A  counter.  */ 

/*/ 

*  Fly  out  all  flying  missiles. 

/*/ 

for  (i  =  0;  i  <  num_adats;  i++) 

if  (adat_array [i] .mptr. state  !=  ADAT_FREE) 

missile_adat_fly  {& (adat_array [ i ] ) ,  sight_location, 
loc_sight_to_world,  i,  veh_list); 

) 

} 


/■tt,******  **********************  ******  *********  ******************* 

'  * 

* 

*  ROUTINE:  raissile_adat_f ly  *  ^  ^  * 

*  PARAMETERS:  aptr  -  A  pointer  to  the  ADAT  missile  that  is  to 

*  be  flown  out- 
sight_location  -  The  location  in  world 

coordinates  of  the  gunner's  * 
sight.  *  ^ 

loc_sight_to_world  -  The  sight  to  world 

transformation  matrix  used  * 
only  in  this  routine.  * 

tube  -  The  tube  the  missile  was  launched  from.  * 
veh_list  -  Vehicle  list  ID. 

*  RETURNS:  none  ^  ^ 

*  PURPOSE:  This  routine  performs  the  functions 

*  specifically  related  to  the  flying  a  ADAT  * 

*  missile. 

★ 

****************************************************************/ 
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void  missile_adat_fly  (aptr,  sight_location,  loc_sight_to_world,  tube, 
veh_list) 

ADAT_MISSILE  *aptr; 

VECTOR  sight_location; 

T_MATRIX  loc_sight_to_world; 
int  tube; 
int  veh_list; 

^  MISSILE  *mptr;  /*  A  pointer  to  the  generic  aspects  of  _aptr_.  */ 

REAL  time;  /*  The  current  time  after  launch  (ticks) .  */ 

REAL  bias;  /*  The  value  of  the  temporal  bias.  */ 

1*1 

*  Set  _mptr_  and  _time_.  These  values  are  created  mostly  for  increased 

*  readablity. 

/*/ 

mptr  =  & {aptr->mptr) ; 
time  =  mptr->time; 

Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed  turn 
angles  in  each  direction.  The  equations  used  are  different  before  and 
after  motor  burnout . 


★ 

★ 

/*/ 


if  (time  <  ADAT_BURNOUT_TIME) 

mptr->speed  =  missile_util_eval_poly  (ADAT_BURN_SPEED_DEG, 
adat  burn_speed_coef f ,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly  (ADAT_BURN_TURN_DEG, 
adat_burn_turn_coef f ,  time) ; 

} 

else 

mptr->speed  =  missile_util_eval_poly  (ADAT_COAST_SPEED_DEG, 
adat  coast_speed_coef f ,  time)  +  mptr->init_speed; 
mptr->cos_max_turn[0]  =  missile_util_eval_poly  ( ADAT_COAST_TURN_DEG , 
adat_coast_turn_coef f ,  time) ; 

) 


(mptr->state  ==  ADAT_CLOSE) ) 


/*/ 

*  Find  the  target  point,  etc. 

1*1 

if  ( (mptr->state  ==  ADAT_GUIDE) 

^  if  ((time  <  ADAT_TEMP_BIAS_TIME)  &&  (mptr->state  ==  ADAT_GUIDE) ) 

bias  =  missile_util_eval_poly  (ADAT_TEMP_BIAS_DEG, 
adat_temp_bias_coef f ,  time); 
if  (((tube  /  2)  *  2)  ==  tube) 

missile_target_los_bias  (mptr,  sight_location, 
loc_sight_to_world,  -bias,  bias); 

else 

missile_target_los_bias  (mptr,  sight_location, 
loc_sight_to_world,  bias,  bias); 


} 

else 


missile_target_los  (mptr,  sight_location,  loc_sight_to_world) ; 
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/*/ 

★ 

★ 

/*/ 


/*/ 

★ 

/*/ 


/*/ 

★ 

★ 

★ 

/*/ 


else  if  {mptr->state  ==  ADAT_UNGUIDE) 
missile_target_unguided  (mptr); 

("MISSILE.ADAT:  disallowed  missile  state  %d\n",  mptr->state) ; 

Try  to  actually  fly  the  missile.  If  this  fails  stop  the  missile  altogether 
and  return . 

if  { !missile_util_f lyout  (mptr)) 

{ 

missile_adat_stop  (aptr) ; 
return; 

}  • 
else- 
{ 

■If  the  missile  successfully  flew,  process  the  proximity  fuze. 

iDissile_fuze_prox  (mptr,  MSL_TYPE_MISSILE,  aptr->target  flag, 

£c  {aptr->target__vehicle_id) ,  &  {aptr->ppt:r)  ,  veh_list , 

■  INVEST_DIST_SQ,  aptr->fuze_dist_sq)  ; 

If  the  missile  successfully  flew,  check  for  an  intersection  with  the 
ground  or  a  vehicle.  If  one  is  found,  blow  up  the  missile,  stop  its 
flyout  and  return. 

if  (missile_util_comm_check_detonate  (mptr,  MSL_TYPE_MISSILE)  ) 


} 


missile_adat_stop  (aptr); 
return ; 


) 


/*/ 

★ 

/*/ 

} 


r 


If  the  missile  is  to  continue  to  fly/  return, 
return ; 


*  ROUTINE:  missile_adat_reset_missiles  ^ 

*  PARAMETERS:  none 

*  RETURNS :  none  _  .  .  * . 

*  PURPOSE:  This  routine  puts  any  flyi«g  missile  into  an 

*  unguided  state . 


void  miss i l6__ciclat_res6t _ missiles  {) 

{ 

int  i;  /*  A  counter.  */ 

/*/ 

*  Reset  all  flying  missiles. 

/*/ 

for  (i  =  0;  i  <  num_ad..ts;  i++) 
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if  ( {adat_array[i] .mptr. state  ==  ADAT_GUIDE)  11 

{adat_array [i] .mptr. state  ==  ADAT_CLOSE) ) 
adat_array [i] .mptr. state  =  ADAT_UNGUIDE; 

} 

} 


/**************************************************************** 

'  * 

* 

*  ROUTINE:  missile_adat_stop  *  ^  •  ..  * 

*  PARAMETERS:  aptr  -  A  pointer  to  the  ADAT  missile  that  is  to 

*  be  stopped. 

*  RETURNS:  none  ^ 

*  PURPOSE:  This  routine  causes  all  concerned  to  forget 

*  ’  about  the  missile.  It  should  be  called  when  * 

*  the  flyout  of  any  ADAT  missile  is  stopped  * 

*  {whether  or  not  it  has  exploded) .  Note  that 

*  this  routine  can  only  be  called  within  this 

*  module. 

* 

*i,i,****  *********************************************************  ^ 


•k 

* 


f 


static  void  missile_adat_stop  (aptr) 

ADAT_MISSILE  *aptr; 

{ 

/  *  /  u 

*  Tell  the  world  to  stop  worrying  about  this  missile  then  release  the 

*  memory  for  use  by  other  missiles. 


missile_fuze_prox_stop  (& (aptr->pptr) ) ; 
missile_util_comm_stop_missile  (& (aptr->mptr) , 
aptr->mptr. state  =  ADAT_FREE; 


MSL_TYPE_MISSILE) ; 
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/*  $Header:  /a3/adst-cm/RWA/AIRNET/siinnet/vehicle/libsrc/libinissile/RCS/miss_atg 

m.c,v  1.4  1993/01/28  23:22:08  cm-adst  Exp  $  */ 

/* 

*  $Log:  miss_atgm.c, V  $ 

*  Revision  1.4  1993/01/28  23:22:08  cm-adst 

*  P.DesMeules  changes  for  spcr  31 

* 

*  Revision  1.3  1993/01/06  21:12:37  cm-adst 

*  R . Branson ‘ s  changes  for  the  weapons  model. 

* 

*  Revision  1.1  1992/09/30  16:39:52  cm-adst 

*  Initial  Version 

* 

Itatic  char  RCS_ID[]  =  ”$Header:  /a3/adst-cm/RWA/AIRNET/simnet/vehicle/libsrc/li 

bmissile/RCS/miss_atgm.c,v  1.4  1993/01/28  23:22:08  cm-adst  Exp  $  ; 
***************************************************************************** 


/ 

★ 

*  Revisions: 

•k 

t 


★ 

* 

★ 

★ 

★ 

★ 

★ 

★ 

★ 

* 

★ 


Version 

Date 

Author 

1.2 

10/23/92 

R.  Branson 

1.3 

10/30/92 

R .  Branson 

1.4 

11/25/92 

R.  Branson 

1.5 

01/19/93 

P .Desmeules 

Title 


SP/CR  Number 


zation 
aded  pathnc 
directory 


fgets  to  make  sure  the 
..whole  line  is  read. in. 


31 


SP/CR  No.  Description  of  Modification 


★ 

★ 

★ 

★ 

★ 

★ 

★ 

* 

★ 

* 

★ 


Hard  coded  defines  changed  to  array  elements. 

Characteristics/parameter  data  array  added. 

Degree  of  polynomial  data  array  added. 

Added  file  reads  for  ATGM  characteristics./ 

parameters,  burn  speed  coefficients,  coast  speed 
coefficients,  burn  turn  coefficients,  and  coast 
turn  coefficients. 


Added  " /simnet/data/ "  to  each  data  file  pathname. 

★ 

*  FILE:  miss_atgm.c 


★ 
★ 
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*  AUTHOR:  Bryant  Col lard  ^ 

*  MAINTAINER:  Bryant  Col lard  ^ 

*  PURPOSE:  This  missile  is  the  same  as  the  tow  except 

*  it  uses  point  targeting.  It  flys  to  a  point  * 

*  rather  than  the  view  direction  * 

★ 

* 

*  HISTORY:  10/31/88  bryant :  Creation 

*  4/26/89  bryant:  Added  statically  allocated  mem  * 

* 

★ 

* 

*  Copyright  (c)  1988  BBN  Systems  and  Technologies,  Inc.  * 

*  All  rights  reserved. 


#include  "stdio.h" 

# include  '‘sim_types  .h" 

# include  "sim_dfns.h“ 
tinclude  "basic. h“ 

# include  "mun_type.h“ 
tt'include  " libmatrix.h" 

# include  "libmap.h" 

# include  “librva.h" 

#include  “miss_atgm.h" 

#include  “ libmiss_dfn .h" 
linclude  " libmiss_loc .h“ 

/* 

*  Debug  macro 
*/■' 

#ifdef  FILEDBG 
#define  P{a)  a 

#else 

#define  P(a) 

#endif 

/*/ 

*  Define  missile  characteristics. 

/*/ 

#define  TOW_BURNOUT_TIME  tow_miss_char [ 0 ] 

#define  TOW_RANGE_LIMIT_TIME  tow_miss_char [ 1 ] 

#define  TOW_MAX_FLIGHT_TIME  tow_miss_char [ 2 ] 

#define  ATGM_TURN_FACTOR  tow_miss_char [ 3 ] 

/  */ 

*  The  following  terms  set  the  order  of  the  polynomials  used  to  determine 

*  the  speed  or  cosine  of  the  maximum  allowed  turn  rate  of  the  missile 

*  at  any  point  in  time. 

/*/ 

idef ine  TOW_BURN_SPEED_DEG  tow_miss_poly_deg [ 0 ] 
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#define  TOW_COAST_SPEED_DEG  tow_iniss_poly_deg [ 1 ] 

#define  TOW_BURN_TURN_DEG  tow_miss_poly_deg [2 ] 

#define  TOW_COAST_TURN_DEG  tow_miss_poly_deg [ 3 ] 

/*/ 

*  Tow  missile  characteristic  parameters  initialized  to  default  values. 

/*/ 

static  REAL  tow_miss_char [5]  = 

{ 

24.0,  /*  ticks  (1.6  sec)  */ 

268.35,  /*  ticks  (17.89  sec)  */ 

200.00,  /*  ticks  -  cos  of  max  turn  >  1.0  beyond  this  point  */ 

0.9,'  /*  ATGM  turn  factor  for  wider  turning  capability  */ 

0.0 

}; 

/*/ 

*  The  following  terms  set  the  order  of  the  polynomials  used  to  determine 

*  the  speed  and  turn  of  the  missile  at  any  point  in  time. 

/*/ 

static  int  tow_miss_poly_deg[5]  = 

{< 

2,  /*  Speed  before  motor  burnout.  */ 

3^  /*  Speed  after  motor  burnout.  */ 

/*  Cosine  of  max  turn  before  burnout.  */ 

3,  /*  Cosine  of  max  turn  after  burnout.  */ 

0  /*  not  used.  */ 

}; 

/*/  .... 

*  Coefficients  for  the  speed  polynomial  before  motor  burnout  initialized  to 

*  default  values. 

1*1 

static  REAL  tow_burn_speed_coef f [5]  = 

4.466666667,  /*  a_0  -  m/tick  (  67.0  m/sec)  */ 

1.222103405,  /*  a_l  -  m/tick**2  (274.9732662  m/sec**2)  */ 

-0.024532086,  /*  a_2  -  m/tick**3  (-82.7057910  m/sec**3)  */ 

0.0, 

0.0 

}; 

/*/ 

*  Coefficients  for  the  speed  polynomial  after  motor  burnout  initialized  to 

*  default  values. 

/*/ 

static  REAL  tow_coast_speed_coef f [5]  = 

21.81905383,  /*  a_0  -  m/tick  (327.2858074  m/sec)  */ 

-9 . 5382019e-2 ,  /*  a_l  -  ra/tick**2  (-21.4609544  m/sec**2)  */ 

2 . 4378222e-4 ,  /*  a_2  -  m/tick**3  (  0.8227650  m/sec**3)  */ 

-2 . 6311111e-7 ,  /*  a_3  -  m/tick**4  (  -0.0133200  m/sec**4)  */ 

0.0 
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}; 


/*/ 

*  Coefficients  for  the  cosine  of  max  turn  polynomials  before  motor  burnout. 

*  The  structure  _MAX_C0S_C0EFF_  is  used  to  store  the  values  for  the  turn 

*  sideways,  up,  and  down  polynomials  along  with  their  order. 

/*/ 


static 

{ 

1, 

( 


{ 


}, 

>  { 


}; 


} 


MAX_COS_COEFF  tow_burn_turn_coef f  = 


/*  order  of  the  polynomials.  */ 


0.999976868652, 
-3 .5933955e-7 


/*  Sidewards  turn.  */ 

/*  a_0  -  cos (rad) /tick  */ 

/*  a_l  -  cos (rad) /tick**2  */ 


0.999960667258, 
-3 .1492328e-6 


/*  Upwards  turn.  */ 

/*  a_0  -  cos (rad) /tick  */ 

/*  a_l  -  cos (rad) /tick**2  */ 


0.999978909989, 
-7 .8194991e-9 


/*  Downwards  turn.  */ 

/*  a_0  -  cos (rad) /tick  */ 

/*  a_l  -  cos (rad) /tick**2  */ 


*  Coefficients  for  the  cosine  of  max  turn  polynomials  after  motor  burnout. 
/*/ 


static 

{ 

3, 

{ 


{ 


{ 


MAX_COS_COEFF  tow_coast_turn_coef f  = 


/*  Order  of  the  polynomials.  */ 


0.99995112518, 

8.96333e-7, 

-5.995375e-9, 

1.162225e-ll 


/*  Sidewards  turn.  */ 

/*  a_0  -  cos (rad) /tick  */ 

/*  a_l  -  cos (rad) /tick**2  */ 
/*  a_2  -  cos (rad) /tick**3  */ 
/*  a_3  -  cos (rad) /tick**4  */ 


0.9998498495, 

1.657779e-6, 

-8.231861e-9, 

1 .381832e-ll 


/*  Upwards  turn.  */ 

/*  a_0  -  cos (rad) /tick  */ 

/*  a_l  -  cos (rad) /tick**2  */ 
/*  a_2  -  cos (rad) /tick**3  */ 
/*  a_3  -  cos (rad) /tick**4  */ 


0.9999714014, 
3 .382077e-7, 
-1.601259e-9, 

2 . 623014e-12 


/ *  Downwards  turn .  * / 

/*  a_0  -  cos (rad) /tick  */ 

/*  a_l  -  cos (rad) /tick**2  */ 
/*  a_2  -  cos (rad) /tick**3  */ 
/*  a_3  -  cos(rad) /tick**4  */ 
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} 

}  ; 

/*/ 

*  Declare  static  functions. 

/*/ 

static  void  inissile_atgm_stop  ( )  ; 


*  ROUTINE:  inissile_atgm_init 

*  PARAMETERS:  tptr  -  a  pointer  to  the  TOW  to  be  ^ 

*  initialized. 

*  RETURNS:  none  ....  ^ 

*  PURPOSE:  This  routine  initializes  the  state  or  the 

*  missile  to  indicate  that  it  is  available  and 

*  sets  values  that  never  change. 


void  missile_atgm_init  (tptr) 
ATGM.MISSILE  *tptr; 

{ 

int  i  ; 

int  data_tmp_int ; 
float  data_tmp; 
char  descript [80] ; 
FILE  *fp; 


P{printf  ("$$$$  ATGM  missile  file  data  $$$$\n'');); 

DEFAULT  CHARACTERISTICS  DATA  FOR  miss_atgm.c  READ  FROM  FILE 
fp  =  f open ( " /s imnet/data/ms_at_ch . d" ,  r  ) ; 

if  (fp==NULL)  {  ,  ^  V,  ..:i\  iM 

fprintf (stderr ,  “Cannot  open  /simnet/data/ms_at_cn.a\n  ; 

exitO  ; 

} 


*/ 


rewind { fp) ; 


/*  Read  array  data  */ 
i  =  0; 


while(fscanf  (fp, Scdata_tmp)  !=  EOF)  { 
tow_miss_char [ i ]  =  data_tmp ; 
fgets {descript,  80,  fp); 

P (printf { " tow_miss_char (%3d)  is%11.3f  %s“, 

descript) ; ) ; 

++i; 

} 


i ,  tow_miss_char [ i ]  , 


/* 


f close (fp); 

END  DEFAULT  CHARACTERISTICS  DATA  FOR  miss_atgm.c 


READ  FROM  FILE 


*/ 
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/*  DEFAULT  BURN  SPEED  DATA  FOR  iniss_atgm.c  READ  FROM  FILE  */ 

fp  =  fopen { " /simnet/data/ms_at_bs .d“ , " r " ) ; 

if  ( fp==NULL)  {  ii\ 

fprintf (stderr,  "Cannot  open  /simnet/data/ms_at_bs . a\n  ; ; 

exit ( ) ; 

} 


rewind ( fp) ; 

/*  Read  degree  of  polynomial  */ 


fscanf  (fp,  ''%d“,  &data_tmp_int)  ; 
T0W_BURN_SPEED_DEG  =  data_tmp_int; 
fgets (descript ,  80,  fp) ; 

P(printf ( "tow_miss_poly_deg(0)  is%3d  %s“, 
descript) ; ) ; 


TOW_BURN_S  PEED_DEG , 


/*  Read  array  data  */ 


while(fscanf (fp, "%f“ ,  &data_tmp)  !=EOF){ 
tow_burn_speed_coef  f [ i ]  =  data_tmp ; 

fgets (descript,  80,  fp); 

P(printf  ( "tow_burn_speed_coeff  (%3d)  is%11.3f  %s'',  i, 

tow_burn_speed_coef f [ i] ,  descript) ; ) ; 

++i; 


f close ( fp) ; 

/*  END  DEFAULT  BURN  SPEED  DATA  FOR  miss_atgm.c  READ  FROM  FILE 


*/ 

*/ 


/*  DEFAULT  COAST  SPEED  DATA  FOR  miss_atgm.c  READ  FROM  FILE 

fp  =  fopen (" /s imnet /data/ms_at_cs . d" ," r  ) ; 

if  (fp==NULL)  {  ^  ^ 

fprintf (stderr,  "Cannot  open  /simnet/data/ms_at_cs .a\n 

exit ( ) ; 

) 


rewind (fp); 

/*  Read  degree  of  polynomial  */ 


fscanf  (fp,  "%d'',  &data_tmp_int)  ; 
TOW_COAST_SPEED_DEG  =  data_tmp_int; 
fgets (descript,  80,  fp) ; 

P (printf ( “ tow_miss_poly_deg ( 1)  is%3d  %s“, 
descript) ; ) ; 


TOW_COAST_S  PEED_DEG , 


/*  Read  array  data  */ 
i  =  0; 

while(fscanf (fp, "%f",  &data_tmp)  !=  EOF) { 
tow_coast_speed_coeff ( i]  =  data_tmp; 
fgets (descript,  80,  fp) ; 
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} 


P(printf  ( "tow_coast_speed_coeff  (%3d)  is%11.3f  %s'',  i, 

tow_coast_speed_coef f [ i ] ,  descript) ; ) ; 


++i; 


fclose { fp) ; 

END  DEFAULT  COAST  SPEED  DATA  FOR  miss_atgm.c  READ  FROM  FILE 


DEFAULT  BURN  TURN  DATA  FOR  miss_atgm.c  READ  FROM  FILE  */ 

fp  =  f open ( " / s imnet /data/ms_at_bt . d" , " r  ' ) ; 

if (fp==NULL) { 

fprintf (stderr,  “Cannot  open  /simnet/data/ms_at_bt . d\n" ) ; 
exit ( ) ; 

} 


rewind (fp) ; 

/*  Read  degree  of  polynomial  */ 

fscanf {fp, ”%d",  &data_tmp_int) ; 

TOW_BURN_TURN_DEG  =  data_tmp_int; 
tow_burn_turn_coef f .deg  =  data_tmp_int ; 
fgets (descript,  80,  fp) ; 

P(printf ( "tow_miss_poly_deg(2)  is%3d  %s“,  TOW_BURN_TURN_DEG , 
descript) ; ) ; 

/*  Read  array  data  */ 

for  (i=0;  i  <=  data_tmp_int ;  i++)  { 

fscanf (fp, "%f" ,  &data_tmp); 

tow_burn_turn_coef f . side_coef f [ i ]  =  data_tmp; 

fgets  {descript,  80,  fp);  •  0.11  if  s. 

P (printf ( “ tow_burn_turn_coef f . side_coef f ( %3d)  is%11.3f  %s  , 

tow_burn_turn_coef f . side_coef f [ i ] ,  descript) ;) , 

} 

for  (i=0;  i  <=  data_tmp_int ;  i++)  { 

fscanf (fp, "%f“ ,  &data_tmp); 

tow_burn_turn_coef f .up_coef f [ i]  =  data_tmp; 

fgets  (descript,  80,  fp)  ;  oc 

P (printf { “tow_burn_turn_coef f .up_coeff (%3d)  is%11.3£  %s  ,  1 

tow_burn_turn_coef f .up_coef f [i] ,  descript) ; ) ; 

} 

for  {i=0;  i  <=  data_tmp_int ;  i++)  { 

fscanf  (fp,  "%f'' ,  &data_tmp); 

tow_burn_turn_coef f . down_coef f [ i ]  =  data_tmp; 

fgets  {descript,  80,  fp)  ;  _ 

P(printf  { ''tow_burn_turn_coeff  .down_coef  f  {%3d)  is%11.3t  -ss  , 

tow_burn_turn_coef f . down_coef f [ i ] ,  descript) , ) , 

} 


fclose (fp); 

END  DEFAULT  BURN  TURN  DATA  FOR  roiss_atgm.c  READ  FROM  FILE 


*/ 
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/*  DEFAULT  COAST  TURN  DATA  FOR  miss_atgm.c  READ  FROM  FILE  */ 

fp  =  fopen { " /simnet/data/ms_at_ct .d” , "r “ ) ; 
if {fp==NULL) { 

fprintf (stderr,  “Cannot  open  /simnet/data/ms_at_ct . d\n" ) ; 
exit ( ) ; 

} 


rewind ( fp) ; 


/*  Read  degree  of  polynomial  */ 

fscanf {fp, "%d" ,  &data_tmp_int) ; 

TOW_COAST_TURN_DEG  =  data_tmp_int; 
tow_coast_turn_coef f .deg  =  data_tmp_int ; 
fgets (descript,  80,  fp); 

P(printf ( "tow_miss_poly_deg (3 )  is%3d  %s“,  TOW_COAST_TURN_DEG , 
descript) ; ) ; 


I 


/*  Read  array  data  */ 


for 


} 


(i=0;  i  <=  data_tmp_int;  i++)  { 
fscanf (fp, ”%f“ ,  &data_tmp); 

tow_coast_turn_coef f . side_coef f [ i )  =  data_tmp; 

fgets {descript,  80,  fp); 

P{printf  ( ''tow_coast_turn_coeff  .side_coeff  (%3d)  is%11.3f  %s“,  i, 

tow_coast_turn_coef f . side_coef f [ i ] ,  descript) ; ) ; 


for 


} 


(i=0;  i  <=  data_tmp_int;  i++)  { 
fscanf ( fp, "%f " ,  &data_tmp); 

tow_coast_turn_coef f .up_coef f [ i]  =  data_tmp; 
fgets {descript,  80,  fp); 

PIprintf { "tow_coast_turn_coef f .up_coef f {%3d)  is%11.3f  %s",  i, 

tow_coast_turn_coef f .up_coef f [ i] ,  descript) ;) ; 


for 


} 


{i=0;  i  <=  data_tmp_int ;  i++)  { 

fscanf (fp, "%f" ,  &data_tmp); 

tow_coast_turn_coef f .down_coef f [ i ]  =  data_tmp; 

fgets {descript,  80,  fp); 

P (printf { " tow_coast_turn_coef f . down_coef f { %3d)  is%11.3f  %s",  i, 

tow_coast_turn_coef f . down_coef f [ i ] ,  descript) ; ) ; 


f close ( fp) ; 

/*  END  DEFAULT  COAST  TURN  DATA  FOR  miss_atgm.c  READ  FROM  FILE  */ 
tptr->mptr. state  =  FALSE; 

tptr->mptr .max_f light_time  =  TOW_MAX_FLIGHT_TIME; 
tptr->mptr .max_turn_directions  =  3; 

/********************************************************************/ 
/*  change  turn  polynomi.al  coefficients  so  missile  has  larger  */ 

/*  max  turn  angle.  Sir ce  Ph  determines  when  a  vehicle  should  be  */ 
/*  impacted,  turn  rates  should  not  effect  missile  effectiveness  */ 
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/********************************************************************/ 
for  {i=0;  i<tow_burn_turn_coeff .deg;  i++) 

tow_burn_turn_coeff.side_coeff[i]  *=  ATGM_TURN_FACTOR; 
tow_burn_turn_coeff .up_coeff[i]  *=  ATGM_TURN_FACTOR; 
tow_burn_turn_coef f .down_coef f [ i]  *=  ATGM_TURN_F ACTOR ; 

for  {i=0;  i<tow_coast_turn_coef f .deg;  i++) 

tow_coast_turn_coef f . side_coef f [ i ]  *=  ATGM_TURN_FACTOR; 

tow_coast_turn_coef f .up_coef f [ i]  *=  ATGM_TURN_FACTOR; 
tow_coast_turn_coef f .down_coef f [ i]  *=  ATGM_TURN_FACTOR ; 

} 


/ 


*  ROUTINE:  missile_atgm_f ire 

*  PARAMETERS:  tptr  -  A  pointer  to  the  TOW  missile  to  be 

*  fired.  * 

PARAMETERS:  launch_point  -  The  location  in  world 

*  coordinates  that  the  missile  is  * 

*  launched  from.  * 

*  loc_sight_to_world  -  The  sight  to  world  ^  * 

*  transformation  matrix  used  * 

*  only  in  this  routine.  * 

*  launch_speed  -  The  speed  of  the  launch  * 

*  platform  (assumed  to  be  in  the  * 

*  direction  of  the  missile) .  * 

*  tube  -  The  tube  the  missile  was  launched  from.  * 

*  RETURNS:  none  * 

*  PURPOSE:  This  routine  performs  the  functions  * 

*  specifically  related  to  the  firing  of  a  TOW  * 

*  missile.  * 


ATGM_MISSILE  *missile_atgm_f ire  (tptr,  launch_point,  loc_sight_to_world, 
launch_speed,  tube,  try_to_hit_target ,  target_id,  target_loc) 
ATGM_MISSILE  *tptr; 

VECTOR  launch_point; 

T_MATRIX  loc_sight_to_world; 

REAL  launch_speed; 
int  tube; 

int  try_to_hit_target ; 

VehiclelD  target_id; 

VECTOR  target_loc; 

MISSILE  *mptr;  /*  Pointer  to  the  particular  generic  missile 

pointed  at  by  _tptr_.  */ 

/*/ 

*  Find  _mptr_. 

/*/ 

mptr  =  & (tptr->mptr) ; 
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*  Set  the  initial  time,  location,  orientation, 

*  missile. 


and  speed  of  the  generic 


/*/ 


/*/ 

★ 


mptr->time  =  0.0; 

vec_copY  {launch_point,  mptr->location) ; 
mat  copy  ( loc_sight_to_world,  mptr->orientation) ; 
mptr->speed  =  missile_util_eval_poly  {TOW_BURN_SPEED_DEG, 
tow_burn_speed_coef f ,  0.0)  +  launch_speed; 

mptr->init_speed  =  launch_speed; 

Set  the  wire  as  uncut. 


/*/ 

tptr->wire_is_cut  =  FALSE; 

/*/ 

*  if  we  are  trying  to  hit  a  target  then  save  the  target_id. 

*  save  the  target  location  (some  point  in  space) 

/*/ 

tptr->try_to_hit_target  =  try_to_hit_target ; 
if  (try_to_hit_target) 

tptr->target_id  =  target_id; 

'  else 

vec_copy { target_loc ,  tptr->target_location) ; 

} 


Otherwise , 


1*1  •  •  U ■ 

*  Tell  the  rest  of  the  world  about  the  firing  of  the  missile.  If  this 

*  cannot  be  done,  return. 

if  ( !missile_util_comm_f ire_inissile  (mptr,  MSL_TYPE_MISSILE, 

map_get_ammo_entry_from_networ)c_type  {munition_US_TOW) , 
munition_US_TOW,  munition_US_TOW,  NULL,  targetUnknown , 
obj ectirrelevant ,  tube)) 
return; 

*  If  all  was  successful,  set  the  missile  state  to  TRUE  and  return. 

/*/ 

mptr->state  =  TRUE; 

return; 


* 


*  ROUTINE:  missile_atgm_f ly  _  ^ 

*  PARAMETERS:  tptr  -  A  pointer  to  the  TOW  missile  that  is  to 

*  be  flown  out. 

*  sight_location  -  The  location  in  world 

*  coordinates  of  the  gunner's  * 

*  sight.  * 

*  loc_sight_to_world  -  The  sight  to  world 

*  transformation  matrix  used  * 

*  only  in  this  routine.  * 

*  RETURNS:  none  * 


★ 
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*  PURPOSE:  This  routine  performs  the  functions  * 

*  specifically  related  to  the  flying  a  TOW  * 

*  missile.  * 


void  missile_atgm_f ly  (tptr,  sight_location,  loc_sight_to_world) 
ATGM_MISSILE  *tptr; 

VECTOR  sight_location; 

T_MATRIX  loc_sight_to_world; 

{ 

MISSILE  *mptr;  /*  A  pointer  to  the  generic  aspects  of  _tptr_.  */ 

REAL  time;  /*  The  current  time  after  launch  (ticks) .  */ 

VehicleAppearanceVariant  *target_vehicle; 

/*  pointer  to  target  vehicles  appearance  packet  */ 


VECTOR  target_plus_of fset ;  /*  this  vector  gives  a  targets  location 

with  an  appropriate  offset  for  ground 

vehs  */ 

static  VECTOR  ground_veh_of f set  =  {0.0,  0.0,  1.0}; 

/*  offset  to  aim  missile  at  for  ground  vehs  */ 

/?/  .  .  ^ 

*  Set  _mptr_  and  _time_.  These  values  are  created  mostly  for  increased 

*  readablity. 

/*/ 

mptr'=  & (tptr->mptr) ; 
time  =  mptr->time; 

/*/  ,  ^ 

*  If  the  missile  has  reached  its  maximum  range  (not  the  maximum  distance 

*  its  allowed  to  fly),  cut  the  wire. 

/*/ 

if  {{time  >  TOW_RANGE_LIMIT_TIME)  &&  ! tptr->wire_is_cut ) 
tptr->wire_is_cut  =  TRUE; 

/*/ 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed  turn 

*  angles  in  each  direction.  The  equations  used  are  different  before  and 

*  after  motor  burnout. 

/*/ 

if  {time  <  TOW_BURNOUT_TIME) 

{ 

mptr->speed  =  missile_util_eval_poly  {TOW_BURN_SPEED_DEC, 
tow_burn_speed_coef f ,  time)  +  mptr->init_speed; 
missile_util_eval_cos_coef f  {mptr,  S:tow_burn_turn_coef f ,  time) ; 

} 

else 

{ 

mptr->speed  =  missile_util_eval_poly  {TOW_COAST_SPEED_DEC, 
tow_coast_speed_coef f ,  time)  +  mptr->init_speed; 
missile_util_eval_cos_coef f  {mptr,  S:tow_coast_turn_coef f ,  time) ; 

} 

/*/ 

*  If  the  wire  has  been  cut,  set  the  ground  as  the  target;  otherwise, 

*  find  a  target  point  which  will  fly  the  missile  along  the  gunner's  line  of 

*  sight.  This  targeting  scheme  takes  into  account  the  errors  introduced  by 

*  attempting  to  guide  the  missile  in  a  canted  position. 
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if  (tptr->wire_is_cut) 

{ 

printf {"G") ; 

missile_target_ground  (mptr); 

} 

else 

/*  if  operator  has  successfully  designated  a  target  then 

*  try_to_hit_target  will  be  true.  Therefore,  we  search  the 

*  list  of  targets  for  the  vehiclelD  and  fly  missile  to  that 

*  location.  ,  .  , 

*  if  try_to_hit_target  is  false  then  target  point  is  passed 

*  and  we  should  fly  the  missile  to  the  target_point . 

*  if  try_to_hit_target  is  true  and  we  can't  find  the 

*  vehicle  id  in  the  rva  list  then  the  vehicle  has  dropped  off  the 

*  and  we  fly  the  missile  into  the  ground. 

* 


/ 

if  {tptr->try_to_hit_target) 


if  { (target_vehicle  =  rva_get_veh_app_pkt  (&(tptr  >target_id) ) ) 
NULL) 

)********************************************************/ 

/*  if  the  target  is  a  ground  vehicle  we  need  to  guide  */ 

/*  the  missile  to  a  point  other  than  the  center  of  mass 
/*  for  SIMNET  ground  vehicles  the  center  of  mass  is  on^ 

/*  the  ground.  This  causes  missiles  to  fly  into  the  */ 

************************************************  / 
if  { {target_vehicle->guises .distinguished  & 

(objectDoraainMask  1  vehicleEnvironmentMask) ) 
{objectDomainVehicle  I  vehicleEnvironmentGround) ) 

vec_add  ( target_vehicle->location,  ground_veh_of fset, 
target_plus_of f set) ; 

} 

else 


*/ 

*/ 


vec_copy  {target_vehicle->location,  target_plus_of fset) 


missile_target_point (mptr ,  target_plus_of fset ) ; 

} 

else 

{ 

/*  printf { "g" ) ;  */ 
missile_target_unguided  (mptr) ; 

} 

} 

else  ■ 


{ 

/ 

/ 


*  printf ( "p" ) ;  */  ******************************/ 
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/*  guide  the  missile  toward  a  point  for  5  ticks,  then  :ust  / 

/*  fly  it  straight  ahead.  With  the  wide  turning  radius  J 
/*  missile  will  fly  around  in  circles  otherwise  */ 

/***i**h!********L*****************************************/ 

if  (time  <  5.0)  , 

missile_target_point (mptr ,  tptr->target_location) , 

else 

missile_target_unguided  (mptr) ; 

} 


} 


/*/ 


/*/ 


/*/ 

★ 

★ 

★ 

/*/ 


Try  to  actually  fly  the  missile.  If  this  fails  stop  the  missile  altogether 
and  return. 

if  { ! miss i le_ut i l_f lyout  (mptr) ) 

{ 

missile_atgm_stop  (tptr) ; 
return; 

) 

else 

{ 

If  the  missile  successfully  flew,  check  for  an  intersection  with  the 
ground  or  a  vehicle.  If  one  is  found,  blow  up  the  missile,  stop  its 
flyout  and  return. 

if  {missile_util_comm_check_intersection  (mptr,  MSL_TYPE_MISSILE) ) 

missile_util_comm_check_detonate  (mptr,  MSL_TYPE_MISSILE) , 
missile_atgm_stop  (tptr) ; 
return; 


) 


} 


If  the  missile  is  to  continue  to  fly,  return, 
return ; 


/*/ 

★ 

/*/ 

} 

************************************************************** 

'  ★ 

★ 

*  ROUTINE:  missile_atgm_stop  *  ^  * 

*  PARAMETERS:  tptr  -  A  pointer  to  the  TOW  missile  that  is  to 

*  be  stopped. 

*  RETURNS:  none  *  ^ 

*  PURPOSE:  This  routine  causes  all  concerned  to  forget 

*  about  the  missile.  It  should  be  called  when 

*  the  flyout  of  any  TOW  missile  is  stopped  * 

*  (whether  or  not  it  has  exploded) .  Note  that  * 

*  this  routine  can  only  be  called  within  this 

★ 

*  module. 

*  ★ 
**************************************************************** ^ 


static  void  miss ile_atgm_s top  (tptr) 
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ATGM_MISSILE  *tptr; 

{ 

^  *  Tell  the  world  to  stop  worrying  about  this  missile  then  release  the 

*  memory  for  use  by  other  missiles. 

^  '  missile_util_comm_stop_missile  (& (tptr->mptr) ,  MSL_TYPE_MISSILE) ; 

tptr->mptr .state  =  FALSE; 

} 

,**************************************************************** 

/  ★ 

*  * 

*  ROUTINE;  missile_atgm_cut_wire  .  ,  •  * 

*  PARAMETERS;  tptr  -  A  pointer  to  the  TOW  missile  whose  wire 

*  is  to  be  cut .  ^ 

*  RETURNS;  none  * 

*  PURPOSE;  This  routine  sets  a  flag  indicating  that  the  ^ 
guidance  wire  of  this  missile  is  cut. 


★ 

★ 


Void  missile_atgm_cut_wire  (tptr) 

ATGM_MISSILE  *tptr; 

{ 

/*/ 

*  If  the  the  wire  is  not  already  cut,  cut  the  wire 
/*/ 

if  ( ! tptr->wire_is_cut) 

tptr->wire_is_cut  =  TRUE; 

} 
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The  following  appendix  contains  the  source  code  listing  for 
miss  atgm.c  for  convenience  in  document  maintenance  and 
understanding  of  the  CSU. 
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/*  SHeader:  /a3/adst-cm/RWA/AIRNET/simnet/vehicle/libsrc/libmissile/RCS/miss_hel 

lfr.c,v  1.4  1993/01/28  23:22:08  cm-adst  Exp  $  */ 

/* 

*  $Log:  miss_hellfr.c,v  $ 

*  Revision  1.4  1993/01/28  23:22:08  cm-adst 

*  P.DesMeules  changes  for  spcr  31 

*  Revision  1.3  1993/01/06  00:45:01  cm-adst 

*  R.  Branson's  weapon  changes. 

*  Revision  1.1  1992/09/30  16:39:52  cm-adst 

*  Initial  Version 

* 

RCS  IDfl  -  "SHeader:  /a3/adst-cm/RWA/AIRNET/simnet/vehicle/libsrc/li 

=,V  1.4  19«/01/28  23.22:08  c-.dst  Exp  8-; 


/ 


*  Revisions: 

★ 


★ 

* 

★ 

•k 

★ 


Version 

Date 

Author 

1.2 

10/23/92 

R. 

Branson 

1.3 

10/30/92 

R. 

Branson 

1.4 

11/25/92 

R. 

Branson 

1.5 

01/19/93 

P. 

■Desmeules 

Title 


SP/CR  Number 


zation 
Ided  pathne 
directory 


31 


fgets  to  make  sure  the 
whole  line  is  read  in. 

. 

* 

*  SP/CR  No.  Description  of  Modification 


★ 

★ 

* 

* 

★ 

★ 


Hard  coded  defines  changed  to  array  elements. 
Characteristics/parameter  data  array  added. 

Degree  of  polynomial  data  array  added.  ^ 

Added  file  reads  for  hellfire  characteristics/ 

parameters,  burn  speed  coefficients,  coast  speed 
coefficients,  and  time-of-f light  coefficients. 

Added  “ /simnet/data/ “  to  each  data  file  pathname. 

***********************************************/ 


★ 


*  FILE: 

*  AUTHOR: 


miss_hellf r . c 
Bryant  Col lard 
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*  MAINTAINER:  Bryant  Col lard 

*  PURPOSE:  This  file  contains  routines  which  fly  out  a 

*  missile  with  the  characteristics  of  a  HELLFIRE 

*  missile. 

*  HISTORY:  11/25/88  bryant :  Creation 

*  4/24/89  bryant:  Added  static  memory  allocation 

*  08/07/90  bryant:  NIU  librva  modifications. 

*  08/09/90  kris:  corrected  flight  coefficients 

* 

*  Copyright  (c)  1988  BBN  Systems  and  Technologies,  Inc. 

*  All  rights  reserved. 


#include  "stdio.h" 

# include  "math.h" 

# include  '‘sim_types  .h" 
# include  “ sim_dfns .h" 
#include  "basic. h" 

# include  “mun_type.h“ 

# include  “libmatrix.h" 
# include  "libmap.h" 


/* —  need  Range_Squared  info  --*/ 
#include  “libhull.h" 

# include  "libkin.h" 

I* _ _ 


#include  "miss_hellf r .h“ 

# include  " libmissile .h" 

# include  " libmiss_dfn .h" 

# include  " libmiss_loc .h" 

/* 

*  Debug  macro 
*/ 

Sifdef  FILEDBG 
#define  P{a)  a 

#else 

#define  P{a) 

#endif 

/*/ 

*  Define  missile  characteristics. 

/*/ 

ftdefine  HELLFIRE_ARM_TIME  hellfr_miss_char [  0] 

#define  HELLFIRE_BURNOUT_TIME  hellfr_miss_char [  1] 

#define  HELLFIRE_MAX_FLIGHT_TIME  hellfr_miss_char [  2] 

#define  SPEED_0  hellfr_miss_char [  3] 

Sdefine  THETA_0  hellf r_miss_char [  4] 

/*/  .  • 

*  Set  parameters  which  will  control  flight  trajectory  behavior. 

/*/ 
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Sdefine  SIN_UNGUIDE 
#define  COS_UNGUIDE 
#define  SIN_CLIMB 
#define  C0S_CLIMB 
# define  SIN_LOCK 
#define  C0S_L0CK 
# define  C0S_TERM 
#define  C0S_L0SE 


hellf r_iniss_char  [  5] 
hellfr_niiss_char  [  6] 
hellfr_miss_char [  7] 
hellf r_miss_char [  8] 
hellf r_miss_char [  9] 
hellf r_miss_char [ 10 ] 
hellf  r_mi ss_char[ll] 
hellf r_miss_char [ 12 ] 


/*/ 

*  The  following  terms  set  the  order  of  the  polynomials  used  to  determine 

*  the  speed  or  cosine  of  the  maximum  allowed  turn  rate  of  the  missile 

*  at  any  point  in  time. 

/*/ 

#define  HELLFIRE_TOF_DEG  hellf r_miss_poly_deg [  0] 

Sdefine  HELLFIRE_BURN_SPEED_DEG  hellf r_miss_poly_deg [  1] 

#define  HELLFIRE_COAST_SPEED_DEG  hellf r_miss_poly_deg [  2] 


/*/ 

*  Hellfire  missile  characteristic  parameters  initialized  to  default  values 
/*/ 

static  REAL  hellf r_miss_char [ 15 ]  = 


20.0, 

/* 

ticks  (1.3  sec) 

*/ 

36.0, 

/* 

ticks  (2.4  sec) 

*/ 

540.0, 

/* 

ticks  (36  sec) 

*/ 

30.95953043, 

/* 

max_speed 

*/ 

0.046542113, 

0.069756474, 

/* 

sin  4.0  deg 

*/ 

0.997564050, 

/* 

cos  4 . 0  deg 

*/ 

0.004072424, 

/* 

sin  3.5  deg 

*/ 

0.999991708, 

/* 

cos  3 . 5  deg 

*/ 

0.156434465, 

/* 

sin  9.0  deg 

*/ 

0.987688341, 

/* 

cos  9.0  deg 

*/ 

0.241921896, 

/* 

cos  76.0  deg 

*/ 

0.939692621, 

/* 

cos  20.0  deg 

*/ 

0.0, 

0.0 

}; 

/*/ 

*  Hellfire  missile  polynomial  degree  initialized  to  default  values. 
/*/ 

static  int  hellf r_miss_poly_deg [  3]  = 

{ 

4,  /*  tof  poly  degree  */ 

3,  /*  burn  speed  poly  degree  */ 

5  /*  coast  speed  poly  degree  */ 

}; 

/*/ 

*  Coefficients  for  the  TOF  polynomial  initialized  to  default  values 
/*/ 

static  REAL  hellf ire_tof_coeff [ 10 ]  = 

{ 
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18.0, 

3 .1461816e-2, 

3 .1921274e-6, 

3 .5260413e-10, 
-2 .8469594e-14, 
0.0, 

0.0, 

0.0, 

0.0, 

0.0 


tick  */ 
tick/meter  */ 
tick/meter"'2  */ 
tick/meter'‘3  */ 
tick/meter''4  */ 
tick/meter''5  */ 
tick/meter'‘6  */ 
tick/meter''7  */ 
tick/meter''8  */ 
tick/meter"'9  */ 


*/  /*  1.2  seconds  */ 
*/ 


Coefficients  for  the  speed  polynomial  before  motor  burnout  initialized  to 
default  values. 

bic  REAL  hellf ire_burn_speed_coef f [ 10 ]  = 


2.0044395e-2, 

6.7384206e-l, 

9.8007701e-3, 

-1.6782227e-4, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0 


/*  a_0  -  meters  */ 
/*  a_l  -  m/tick  */ 
/*  a_2  -  m/tick^2  */ 
/*  a_3  -  m/tick^3  */ 
/*  a_4  -  m/tick^4  */ 
/*  a_5  -  m/tick''5  */ 
/*  a_6  -  m/tick''6  */ 
/*  a_7  -  m/tick''7  */ 
/*  a_8  -  m/tick^8  */ 
/*  a  9  -  m/tick''9  */ 


*  Coefficients  for  the  speed  polynomial  after  motor  burnout  initialized  to 

*  default  values. 

/*/ 

static  REAL  hellf ire_coast_speed_coef f [ 10 ]  = 


4.2738447e+l, 

-4.1048613e-l, 

■  2.6023604e-3, 
-8.4870417e-6, 
1.3322932e-8, 
-7.9542005e-12, 
0.0, 

0.0, 

0.0, 

0.0 


/*  a_0  -  meters 
/*  a_l  -  m/tick 
/*  a_2  -  m/tick^2 
/*  a_3  -  m/tick''3 
/*  a_4  -  m/tick"'4 
/*  a_5  -  m/tick'^B 
/*  a_6  -  m/tick'’6 
/*  a_7  -  m/tick^7 
/*  a_8  -  m/tick^'S 
/*  a_9  -  m/tick''9 


static  ObjectType  hellf ire_amrao_type  =  munition_US_Hellf ire ; 
static  REAL 

max_range_limit,  /*  [  MISSILE_US_MAX_RANGE_LIMIT  ] 

max_range_squared,  /*  [  MISSILE_US_MAX_RANGE_LIMIT  2  ] 

speed_factor;  /*  [  MISSILE_US_SPEED_FACTOR  ] 
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*  Declare  static  functions. 

1*1 

static  void  missile.hellf ire_stop  {); 

/**************************************************************** 

'  ★ 

★ 

•  •  ^ 

*  ROUTINE:  missile_hellf ire_init  ^ 

*  PARAMETERS:  mptr  -  a  pointer  to  the  HELLFIRE  to  be 

*  initialized.  * 

*  RETURNS:  none  ...  .f  * 

*  PURPOSE:  This  routine  initializes  the  state  ot  tne 

*  missile  to  indicate  that  it  is  available  and  ^ 

*  sets  values  that  never  change. 

* 

****************************************************************/ 

void  missile_hellf ire_init  (mptr) 

MISSILE  *inptr; 

{ 

int  i ; 

int  data_tmp_int; 

'  float  data_tmp; 

char  descript [80] ; 

FILE  *fp; 

P{printf {“$$$$  HELLFIRE  missile  file  data  $$$$\n");); 

/*  DEFAULT  CHARACTERISTIC  DATA  FOR  miss_hellf r . c  READ  FROM  FILE  */ 

fp  =  f open ( " /s imnet /data/ms_hf_ch . d" , “ r  ' ) ; 

^  fprintf {stderr,  "Cannot  open  /simnet/data/ms_hf_ch.d\n“ ) ; 
exit ( ) ; 

} 

rewind (fp) ; 

/*  Read  array  data  */ 
i  =  0; 

while{fscanf (fp, "%f”,  &data_tmp)  !=EOF) 

{ 

hellfr_miss_char [ i ]  =  data_tmp; 
fgets (descript,  80,  fp); 

P (printf ( "hellf r_miss_char (%3d)  is%11.3f  %s",  i, 
hellfr_miss_char [i] ,  descript) ; ) ; 


fclose(fp) / 

/*  END  DEFAULT  CHARACTERISTIC  DATA  FOR  miss_hellfr . c  READ  FROM  FILE 
/*  DEFAULT  TIME-OF-FLIGHT  DATA  FOR  miss_hellf r . c  READ  FROM  FILE  */ 

fp  =  fopen ( “ /simnet/data/ms_hf_tf .d" , "r" ) ; 

^  fprintf (stderr,  "Cannot  open  /simnet/data/ms_hf_tf -dXn" ) ; 
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} 


exit  { )  ; 


rewind { fp) ; 


/*  Read  degree  of  polynomial 


fscanf  {fp, ‘'%d'‘,  &data_tmp_int); 
hellfr_miss_poly_deg [0]  =  data_tmp_int; 

fgets (descript,  80,  fp) ; 

P(printf ("hellfr_miss_poly_deg(0)  is%3d  %s  ,  _ 

hellf r_miss_poly„deg [ 0 ] ,  descript) ; 


)  ; 


/*  Read  array  data  */ 


i=0  ; 

while(fscanf  (fp, ''%f“,  &data_tmp)  !=EOF) 

hellf ire_tof_coef f [ i]  =  data_tmp; 
fgets  (descript,  80,  fp); 

P{printf ( “hellf ire_tof_coeff (%3d)  is%11.3f  %s  ,  i, 

hellf ire_tof_coeff [ i] ,  descript) ; ) ; 

++i ; 

} 


/*  END*^DEFAULT^TIME-0F-FLIGHT  data  for  roiss_hellfr.c  READ  FROM  FILE  */ 
/*  DEFAULT  BURN  SPEED  DATA  FOR  miss_hellf r . c  READ  FROM  FILE  */ 

fp  =  fopen { " /simnet/data/ms_hf_bs .d" , "r" ) ; 

fprintf (stderr,  "Cannot  open  /simnet/data/ms_hf_bs .d\n" ) ; 
exit ( ) ; 

} 


rewind { fp) ; 

/*  Read  degree  of  polynomial  */ 

fscanf  (fp,  "%d",  S:data_tmp_int)  ; 
hellfr_miss_poly_deg[l]  =  data_tmp_int ; 
fgets {descript,  80,  fp); 

P(printf (“hellf r_miss_poly_deg{l)  is%3d  %s", 

hellfr_miss_poly_deg [1] ,  descript) ; ) ; 


/*  Read  array  data  */ 


i  =  0  ; 

while(fscanf (fp, "%f ",  &data_tmp)  !=EOF) 

hellfire_burn_Epeed_coeff [i]  =  data_tmp; 

fgets  {descript,  80,  fp)  ;  o.  „  ^ 

P{printf  ( “hellf  ■;  re_burn_speed_coef  f  {%3d)  is%11.3f  %s  ,  i. 
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hellf ire_burn_speed_coef f [ i]  ,  descript) ; ) ; 


++i; 


} 


/* 

/* 


ENd'^ DEFAULT^  BURN  SPEED  DATA  FOR  miss_hellf  r .  c  READ  FROM  FILE  */ 
DEFAULT  COAST  SPEED  DATA  FOR  miss_hellf r . c  READ  FROM  FILE  */ 

fp  =  f  open  { "  /  simnet /data/nis_hf_cs  .  d  ,  v  ), 

^  ^  fprintf (stderr,  “Cannot  open  /simnet/data/ins_hf_cs .d\n" ) ; 
exit ( ) ; 

} 


rewind { fp) ; 

/*  Read  degree  of  polynomial 


V 


fscanf (fp, "%d",  &data_tmp_int) ; 
hellfr_miss_poly_deg [2 ]  =  data_tmp_int ; 

f gets (descript,  80,  fp); 

P(printf ( "hellfr_miss_poly_deg(2)  is%3d  %s“, 

hellf r_miss_poly_deg [2 ] ,  descript) ; ) ; 


/• 


Read  array  data 


W 


i  =  0; 


while(fscanf (fp, "%f",  &data_tmp)  !=  EOF) 

hellf ire_coast_speed_coef f [ i]  =  data_tmp; 
fgets (descript,  80,  fp) ; 

P(printf ( "hellf ire_coast_speed_coeff (%3d) 
hellf ire_coast_speed_coef f [ i] 


is%11.3f  %s",  i, 
descript)  ; )  ; 


} 


++i; 


fclos©(fp) / 

/*  END  DEFAULT  COAST  SPEED  DATA  FOR  miss_hellfr . c  READ  FROM  FILE  */ 
mptr->state  =  FALSE; 

mptr->max_flight_time  =  HELLFIRE_MAX_FLIGHT_TIME; 
mptr->max_turn_directions  =  1; 
speed_factor  =  MISSILE_US_SPEED_FACTOR; 

iinax_range_limit  =  MISSILE_US_MAX _ RANGE — LIMIT; 

max_range_squared  =  max_range_limit  *  max_range_limit ; 
hellf ire_ammo_type  =  munition_US_Hellf ire; 

} 

void  missile_hellfire_set_speed_factor(  scale_speed  ) 

REAL  scale_speed; 

{ 

speed_f actor  =  scale_speed; 

} 
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void  missile_hellfire_set_niax_range_liniit{  limit_range  ) 

REAL  limit_range; 

{  ... 

max  range_limit  =  limit_range; 

maxlrange_squared  =  max_range_limit  *  max_range_limit , 

} 

void  missile_hellfire_set_ammo_type(  ammo  ) 

ObjectType  ammo; 

{ 

hellf ire_ammo_type  =  ammo; 

} 

/*****************************************************;********** 

*  ROUTINE:  missile_hellf ire_calc_tof  ^ 

*  PARAMETERS:  range  -  Range  to  target.  ^  ^  * 

*  RETURNS:  Time  Of  Flight  for  _range_  meters  to  target.  ^ 

*  PURPOSE:  This  routine  evaluates  the  TOF  poly  an  re  urns  ^ 

*  the  time  of  flight  for  a  Hellfire  Missile 

*  to  flv  range  meters. 

***************************************************************  ' 

I 

REAL  missile_hellf ire_calc_tof (  range  ) 

REAL  range; 

{ 

.REAL  time; 

^^"'\issile_util_eval_poly(  HELLFIRE_TOF_DEG,  hellf ire_tof_coeff ,  range  ); 
return (  (time  /  speed_factor)  ); 


} 


ROUTINE;  missile_hellf ire_f ire  .  -t  * 

PARAMETERS;  mptr  -  A  pointer  to  the  HELLFIRE  missi  e 

is  to  be  launched.  ^ 

launch_point  -  The  location  in  world  ,  , 

coordinates  that  the  missile  is 
launched  from. 

launch_to_world  -  The  transformation  matrix  of  * 
the  launch  platform  to  the 
world.  *  ^ 

launch_speed  -  The  speed  of  the  launch  ^  * 

platform  (assumed  to  be  in  the 
direction  of  the  missile) . 
tube  -  The  tube  the  missile  was  launched  from. 

RETURNS;  none  ,  ^ 

*  PURPOSE:  This  routine  performs  the  functions  ^ 

*  specifically  related  to  the  firing  of  a 

*  Hellfire  missile.  ^ 

!***************************************************************/ 

void  missile_hellfire_fire  (mptr,  launch_point,  launch_to_world,  launch.speed, 
tube) 
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MISSILE  *mptr; 

VECTOR  launch_point ; 

T_MATRIX  launch_to_world; 

REAL  launch_speed; 
int  tube; 

{ 

/*/ 

*  Set  the  initial  time,  location,  orientation,  and  speed  of  the  generic 

*  missile. 

/*/ 

#ifdef  notdeff 

if{  max_range_limit  >0.0  ) 
mptr->max_f light_time  = 

1.0  +  missile_hellf ire_calc_tof (  max_range_limit  ) ; 

#endif 

mptr->time  =  0.0; 

vec_copy  { launch_point,  mptr->location) ; 
mat_copy  { launch_to_world,  mptr->orientation) ; 
mptr->speed  =  launch_speed  + 

( speed_factor  *  (missile_util_eval_poly  {HELLFIRE_BURN_SPEED_DEG, 

hell f ire_burn_speed_coef  f , 

,  0.0)  )); 

mptr->init_speed  =  launch_speed; 

/*/ 

*  Tell  the  rest  of  the  world  about  the  firing  of  the  missile.  If  this 

*  cannot  be  done,'  return. 

/*/ 

if  { !missile_util_comm_f ire_missile  (mptr,  MSL_TYPE_MISSILE, 

map_get_ammo_entry_from_network_type  (hellf ire_ammo_type) , 
hellf ire_ammo_type,  hellf ire_ammo_type,  NULL, 
targetUnknown,  objectirrelevant,  tube)) 
return; 

/*/ 

*  If  all  was  successful,  set  the  missile  state  to  TRUE  and  return. 

/*/ 

mptr->state  =  TRUE; 
return; 

) 

/**************************************************************** 

*  * 

*  ROUTINE:  missile_hellf ire_f ly  * 

*  PARAMETERS:  mptr  -  A  pointer  to  the  HELLFIRE  missile  that  * 

*  is  to  be  flown  out.  * 

*  target_location  -  The  location  in  world  * 

*  coordinates  of  the  target.  * 

*  RETURNS:  none  * 

*  PURPOSE:  This  routine  performs  the  functions  * 

*  specifically  related  to  the  flying  a  HELLFIRE  * 

*  missile.  * 

*  * 

****************************************************************/ 


void  missile_hellf ire_f ly  (mptr,  target_location) 
MISSILE  *mptr; 
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VECTOR  target_location; 

{ 

register  REAL  time; 

/*/ 

*  Set  and  _time_.  This  is  created  mostly  for  increased  readablity. 


/*  The  current  time  after  launch  (ticks) .  */ 


/*/ 


time  =  mptr->time; 


/*/ 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed  turn 

*  angles  in  each  direction.  The  equations  used  are  different  before  and 

*  after  motor  burnout. 

/*/ 

if  (time  <  HELLFIRE_BURNOUT_TIME) 

{ 

mptr->speed  =  mptr->init_speed  + 

(speed_f actor  * 

(missile_util_eval_poly  (HELLFIRE_BURN_SPEED_DEG, 

hellf ire_burn_speed_coef f ,  time)  )); 

} 

else 

.  { 

mptr->speed  =  mptr->init_speed  + 

(speed_f actor  * 

(missile_util_eval_poly  (HELLFIRE_COAST_SPEED_DEG, 

hellf ire_coast_speed_coef f ,  time)  ) ) ; 

} 

/*/ 

*  Note  that  this  is  a  temporary  method  of  finding  the  max  turn  angle. 

/*/ 

mptr->cos_max_turn[0]  =  cos  (sqrt  (mptr->speed  /  SPEED_0)  *  THETA_0); 

/*/ 

*  If  the  missile  is  not  armed,  fly  in  a  search  trajectory;  otherwise,  fly 

*  in  a  targeted  trajectory. 


/*/ 


/*/ 


if(  max_range_limit  >  0  && 

kinematics_range_squared  (veh_kinematics ,  mptr->location)  > 
max_range_squared  ) 
missile_target_ground(  mptr  ); 
else  if  (time  <  HELLFIRE_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE,  SIN_CLIMB, 
COS_CLIMB,  SIN_LOCK,  COS_LOCK,  COS_TERM,  C0S_L0SE) ; 

else 

missile_target_agm  (mptr,  target_location,  SIN_UNGUIDE,  COS_UNGUIDE, 
SIN_CLIMB,  COS_CLIMB,  SIN_LOCK,  COS_LOCK,  COS_TERM,  COS_LOSE) ; 


*  Try  to  actually  fly  the  missile.  If  this  fails  stop  the  missile  altogether 

*  and  return. 


if  ( !missile_util_flyout  (mptr)) 

{ 

missile_hellf ire_stop  (mptr) ; 
return; 

} 

else 

{ 
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*  If  the  missile  successfully  flew,  check  for  an  intersection  with  the 

*  ground  or  a  vehicle.  If  one  is  found,  blow  up  the  missile,  stop  its 

*  flyout  and  return. 

if  (missile_util_comm_check_intersection  {mptr,  MSL_TYPE_MISSILE) ) 

missile_util_comm_check_detonate  (mptr,  MSL_TYPE_MISSILE) , 

missile_hellf ire_stop  (mptr) ; 

return; 

} 

} 

/*/ 

*  If  the  missile  is  to  continue  to  fly,  return. 

/*/ 

return; 

) 


/**************************************************************** 

’  * 
it 

*  ROUTINE:  missile_hellf ire_stop  . 

^  PARAMETERS:  mptr  -  A  pointer  to  the  HELLFIRE  missile  that 

*  is  to  be  stopped.  * 

*  RETURNS:  none  *  ^ 

*  PURPOSE:  This  routine  causes  all  concerned  to  forget 

*  about  the  missile-.  It  should  be  called  when  * 

*  the  flyout  of  any  HELLFIRE  missile  is  stopped 

»  (whether  or  not  it  has  exploded) .  Note  that  * 

*  this  routine  can  only  be  called  within  this  * 

it 

*  module . 

* 

* 

****************************************************************/ 


static  void  missile_hellf ire_stop  (mptr) 

MISSILE  *mptr; 

{ 

/  *  / 

*  Tell  the  world  to  stop  worrying  about  this  missile  then  release  the 

*  memory  for  use  by  other  missiles. 

1*1 

missile_util_comm_stop_missile  (mptr,  MSL_TYPE_MISSILE) ; 
mptr->state  =  FALSE; 

) 
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The  following  appendix  contains  the  source  code  listing  for 
miss  kem.c  for  convenience  in  document  maintenance  and 
understanding  of  the  CSU. 
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/*  $Header:  /a3/adst-cm/RWA/AIRNET/simnet/vehicle/libsrc/libmissile/RCS/iniss_kem 

.c,v  1.4  1993/01/28  23:22:08  cm-adst  Exp  $  */ 

/* 

*  $Log:  miss_kem.c, V  $ 

*  Revision  1.4  1993/01/28  23:22:08  cm-adst 

*  P.DesMeules  changes  for  spcr  31 

* 

*  Revision  1.3  1993/01/06  21:13:01  cm-adst 

*  R. Branson’s  changes  for  the  weapons  model. 

* 

*  Revision  1.1  1992/09/30  16:39:52  cm-adst 

*  Initial  Version 

* 

Static  char  RCS  ID[]  =  "SHeader:  /a3/adst-cm/RWA/AIRNET/simnet/vehicle/libsrc/li 

Ssrile/RCS/mi;s_kem.c,v  1.4  1993/01/28  23:22:08  cm-adst  Exp 

/***************************************************************************** 

★ 

*  Revisions: 


*» 

★ 


Version 

Date 

Author 

1.2 

10/23/92 

R. 

Branson 

1.3 

10/30/92 

R. 

Branson 

1.4 

11/25/92 

R. 

.  Branson 

1.5 

01/19/93 

P, 

.  Desmeules 

Title 


SP/CR  Number 


zation 
Jded  pathnc 
directory 


31 


fgets  to  make  sure  the 

*  whole  line  is  read  in. 
*****************************************************************************/ 

/***************************************************************************** 

* 

*  SP/CR  No.  Description  of  Modification 


Hard  coded  defines  changed  to  array  elements. 

Characteristics/parameter  data  array  added. 

Degree  of  polynomial  data  array  added. 

Added  file  reads  for  KEM  characteristics/parameters, 
burn  speed  coefficients,  coast  speed  coefficients, 
burn  turn  coefficients,  and  coast  turn  coeffi¬ 
cients  . 


Added  " /simnet/data/ ”  to  each  data  file  pathname. 


***********************■’ 
*  FILE:  miss_kem.c 


y  *  * 
★ 
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*  AUTHOR: 

*  MAINTAINER; 

* 

*  PURPOSE: 

★ 

★ 

*  HISTORY: 


Kris  Bartol 

Kris  Bartol :  converted  from  miss_adat 

This  file  contains  routines  which  fly  out  a 
missile  with  the  characteristics  of  a  KEM 
missile. 

10/23/90  kris:  converted  from  miss_adat 


★ 

★ 

★ 

★ 

★ 

★ 

it 

★ 


★ 

★ 

★ 

★ 

★ 


Copyright  (c)  1989  BBN  Systems  and  Technologies, 
All  rights  reserved. 


Inc . 


★ 


#include  "stdio.h" 
# include  "math.h" 


# include 
Sinclude 
# include 
# include 
tt^include 
# include 


"sim_types .h" 
"sim_dfns .h" 
“basic .h“ 
“mun_type .h" 

" 1 ibmap . h " 
"libmatrix.h" 


#include  "miss_kem.h" 


#include  “ libmiss_dfn .h" 
#include  " libmiss_loc .h" 


/* 

*  Debug  macro 

*/ 

#ifdef  FILEDBG 
idefine  P{a)  a 

#else 

#define  P(a) 

#endif 


/*/ 

*  Define  missile  characteristics. 

/*/ 

#define  KEM_BURNOUT_TIME  kem_miss_char [ 0 ] 

#define  KEM_MAX_FLIGHT_TIME  kem_miss_char [ 1 ] 

/* 

*  just  after  burnout,  max  V  =  -3418  m/tick  =  -230  m/sec 

*  so  in  order  to  get  the  KEM  missile  to  fly  @  Vmax  =  1524  m/2 

*  must  multiply  the  speed  calculated  by  6.626  -=  1524  /  230 

*/ 

#define  KEM_TO_MACH5_F ACTOR  kem_miss_char [ 2 ] 


V-  • 

*  Define  the  states  the  _KEM_MISSILE_  can  be  in. 
/*/ 

#define  KEM_FREE  0  /*  No  missile  assigned.  */ 
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ftdefine  KEM_GUIDE  1  /*  Missile  flying  and  guided.  */ 

#define  KEM_UNGUIDE  2  /*  Missile  flying  but  unguided.  */ 

^ *  The  following  terms  set  the  order  of  the  polynomials  used  to  determine 

*  the  speed  or  cosine  of  the  maximum  allowed  turn  rate  of  the  missile 

*  at  any  point  in  time. 

/*/ 

#define  KEM_BURN_SPEED_DEG  kem_miss_poly_deg [ 0 ] 

#define  KEM_COAST_SPEED_DEG  ' kem_miss_poly_deg [ 1 ] 

#define  KEM_BURN_TURN_DEG  kem_miss_poly_deg [2 ] 

idefine  KEM_COAST_TURN_DEG  kem_miss_poly_deg [3 ] 

/  */ 

*  ADAT  missile  characteristic  parameters  initialized  to  default  values. 
/*/ 

static  REAL  kem_miss_char [ 10 ]  = 

{ 

48.0,  /*  ticks  (3.2  sec)  */ 

<  300.00,  /*  ticks  (20.0  sec)  */ 

6.626,  /*  speed  factor  to  raise  from  ADAT  to  KEM  */ 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0 

}; 

/*/ 

*  The  following  are  the  default  values  of  the  degree  of  polynomials. 

/*/ 

static  int  kem_miss_poly_deg [ 5]  = 

^2,  /*  Speed  before  motor  burnout.  */ 

4^  /*  Speed  after  motor  burnout.  */ 

3^  /*  Cosine  of  max  turn  before  burnout.  */ 

5"  /*  Cosine  of  max  turn  after  burnout.  */ 

0 

}; 

/  *  / 

*  Coefficients  for  the  speed  polynomial  before  motor  burnout  initialized 

*  to  default  values. 

/*/ 

static  REAL  kem_burn_speed_coeff [10]  = 

^  2.296,  /*  a_0  -  m/tick  */ 

0.72990856,  /*  a_l  -  m/tick**2  */ 

0.013310932,  /*  a_2  -  m/tick**3  */ 
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0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0 


^  *  Coefficients  for  the  speeci  polynomial  after  motor  burnout 
/*/ 


static  REAL  kem_coast, 

{ 

105.52162, 

-1.0157285, 

5.6124330e-3, 

-1.6262608e-5, 

1.8991982e-8, 

'  0.0, 

0.0, 

0.0, 

0.0, 

0.0 


speed_coef f [ 10 ]  - 

/*  a_0  -  m/tick  */ 

/*  a_l  -  m/tick**2  */ 
/*  a_2  -  m/tick**3  */ 
/*  a_3  -  m/tick**4  */ 
/*  a_4  -  m/tick**5  */ 


'**  Coefficients  for  the  cosine  of  max  turn  polynomial  before  motor  burnout 
/*/ 


static  REAL  kem_burn_turn_coef f [10]  = 


{ 

0.999993, 

-6.2386917e-7, 

1.6146426e-7, 

-9.720142e-7, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0 


/*  a_0  -  cos (rad) /tick  */ 
/*  a_l  -  cos (rad) /tick**2 
/*  a_2  -  cos (rad) /tick**3 
/*  a_3  -  cos (rad) /tick**4 


*/ 

*/ 

*/ 


}; 


Coefficients  for  the  cosine  of  max  turn  polynomial  after  motor  burnout 

/*/ 


static  REAL  kem_coast_turn_coef f [ 10 ] 


{ 

0.99753111,  / 

5.5817986e-5,  / 

-5.1276276e-7,  / 

2 .2388593e-9,  / 


a_0  -  cos (rad) /tick  */ 
a_l  -  cos (rad) /tick**2 
a_2  -  cos(rad) /tick**3 
a_3  -  cos(rad) /tick**4 


*/ 

*/ 

*/ 
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-5.1964622e-12, 

4.54991046-15, 

0.0, 

0.0, 

0.0, 

0.0 


/*  a_4  -  cos  (rad) /tick:**5  */ 
/*  a_5  -  cos(rad)/tick**6  */ 


/*/ 

* 

★ 

★ 


Memory 

initial 

issues 


for  the  missiles  is  declared  in  vehicle  specific  code.  During 
ization,  a  pointer  is  assigned  to  this  memory  then  some  memory 
are  dealt  with  in  this  module. 


/*/ 


static  KEM_MISSILE  *kem_array; 
static  int  num_kems; 


/*  A  pointer  to  missile  memory.  */ 

/*  The  number  of  defined  missiles.  */ 


/*/ 

*  Declare  static  functions. 

/*/ 

f 

static  void  missile_kem_stop  {); 


/**************************************************************** 

'  * 

* 

*  ROUTINE;  missile_kem_init  _  ^ 

*  PARAMETERS:  missile_array  -  A  pointer  to  an  array  or 

*  KEM  missiles  defined  in  * 

*  vehicle  specific  code. 

*  num_missiles  -  The  number  missiles  defined  in  * 

*  _missile_array_.  * 

*  RETURNS;  none  .  * 

*  PURPOSE;  This  routine  copies  the  parameters  into  ^ 

*  variables  static  to  this  module  and  initializes 

*  the  state  of  all  the  missiles.  * 

★ 

!***************************************************************/ 


void  missile_kem_init  {missile_array,  num_missiles) 
KEM_MISSILE  missile_array [ ] ; 
int  num_missiles ; 

{ 

int  i;  /*  A  counter.  */ 
int  data_tmp_int ; 
float  data_tmp; 
char  descript [80 ] ; 

FILE  *fp; 


/* 


P (printf ( " $$$$$  KEM  missile  file  data  $$$$\n" ) ; ) ; 


DEFAULT  CHARACTERISTICS  DATA  FOR  miss_ 

fp  =  fopen{ '’/simnet/data/ms_km_ch.d" 

if (fp==NULL) { 

fprintf (stderr,  “Cannot  open  / 
exit { ) ; 


kem.c  READ  FROM  FILE 
,  "r"); 

s imnet/data/ms_km_ch . d\n " ) ; 


*/ 
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rewind { fp) ; 

/*  Read  array  data  */ 
i=0; 

while{fscanf (fp, "%f",  &data_tmp)  !=EOF){ 
kem_miss_char [ i ]  =  data_tmp; 
fgets {descript,  80,  fp); 

P{printf  { "kem_miss_char  (%3d)  is%11.3f  %s'',  i, 

kem_iniss_char  [ i ] ,  descript)  ; )  ; 

++i; 


/*  ENd'^DEFAuS^  CHARACTERISTICS  DATA  FOR  miss.kem.c  READ  FROM  FILE 
/*  DEFAULT  BURN  SPEED  DATA  FOR  miss_kein.c  READ  FROM  FILE  */ 

fp  =  f open  { “ /s imnet /data/ins_kin_bs  .  d  ,  r  )  , 

'  if  Up  "Cannot  open  /simnet/data/ins_km_bs  .d\n“ )  ; 

exit { ) ; 

) 

rewind ( fp) ; 

/*  Read  degree  of  polynomial  */ 

fscanf  (fp,  "%d",  Scdata_tmp_int )  ; 

KEM_BURN_SPEED_DEG  =  data_tmp_int ; 
fgets {descript,  80,  fp); 

P {printf { "kem_miss_poly_deg (0)  is%3d  %s“, 

KEM_BURN_SPEED_DEG,  descript) ; ) ; 

/*  Read  array  data  */ 

i=0  ; 

while{fscanf  {fp,  "%f'',  &data_tmp)  !=  EOF)  { 
kem_burn_speed_coef f [ i ]  =  data_tmp; 

fgets  {descript,  80,  fp)  ;  .  -ic  5.  ..  ^ 

P {printf { "kem_burn_speed_coeff {%3d)  is%11.3t  ,  1, 

kem_burn_speed_coef f [ i ] ,  descript) ; ) , 

++i; 

} 

fclOSS{fp)/  TT'TOrMUT  T  T  T  "P  *  / 

/*  END  DEFAULT  BURN  SPEED  DATA  FOR  miss_kem.c  READ  FROM  hint, 

/*  DEFAULT  COAST  SPEED  DATA  FOR  miss_kem.c  READ  FROM  FILE  */ 

fp  =  f open  {“/ s  imnet /data/ms_)oti_cs  .  d  ,  r  )  , 

fprintf {stderr,  "Cannot  open  /simnet/data/ms_km_cs .d\n' 
exit { ) ; 

} 
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rewind (fp) ; 


/*  Read  degree  of  polynomial  */ 

fscanf  (fp,  "%d'',  &data_tinp_int)  ; 
KEM_COAST_SPEED_DEG  =  data_tmp_int ; 
fgets {descript ,  80,  fp) ; 

P (printf ( “kem_miss_poly_deg (1)  is%3d  %s", 
KEM_COAST_SPEED_DEG,  descript) ; ) ; 


/*  Read  array  data  */ 
i  =  0; 


while(fscanf (fp, "%f",  &data_tmp)  !=EOF){ 
l<em_coast_speed_coef  f  [  i]  =  data_tmp; 
fgets (descript,  80,  fp); 

P  (printf  ( "lcem_coast_speed_coef  f  (%3d)  is%11.3f  %s“,  i, 

)cem_coast_speed_coef  f  [  i] ,  descript)  ; )  ; 

++i; 


f  close  (fp);  r'TT  T?  */ 

/*  END  DEFAULT  COAST  SPEED  DATA  FOR  miss_)cem.c  READ  FROM  FILE  / 

/*  DEFAULT  BURN  TURN  DATA  FOR  miss_kem.c  READ  FROM  FILE  */ 

fp  =  fopen(''/simnet/data/ms_km_bt.d",  “r")  ; 

if  {fp==NULL)  {  ,  ,  u,.  jv  ..N 

fprintf  (stderr,  "Cannot  open  /simnet/data/ms_km_t)t  .a\n  ;; 

exit { ) ; 

} 


rewind { fp) ; 

/*  Read  degree  of  polynomial  */ 

fscanf (fp, "%d",  &data_tmp_int) ; 

KEM_BURN_TURN_DEG  =  data_tmp_int ; 
fgets (descript,  80,  fp) ; 

P(printf ( "kem_miss_poly_deg (2)  is%3d  %s", 
KEM_BURN_TURN_DEG ,  descript) ; ) ; 

/*  Read  array  data  */ 

i=0; 

while{fscanf (fp, "%f " ,  &data_tmp)  !=EOF){ 
kem_burn_turn_coef f [i]  =  data_tmp; 
fgets (descript,  80,  fp); 

P (printf ( "kem_burn_turn_coef f {%3d)  is%11.3f  %s",  i, 

kem_burn_turn_coef f [i] ,  descript) ; ) ; 

++i  ; 

} 


f close { fp) ; 

/*  END  DEFAULT  BURN  TURN  DATA  FOR  miss_kem.c  READ  FROM  FILE 


*/ 
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/*  DEFAULT  COAST  TURN  DATA  FOR  iniss_kem.c  READ  FROM  FILE  */ 

fp  =  f open  { "  / simnet /data/iiis_kin_ct . d” ,  r  )/ 

^  ^  fprintf (stderr,  "Cannot  open  /simnet/data/ms_km_ct .d\n  ) ; 
exit { ) ; 

} 


rewind { fp) ; 

/*  Read  degree  of  polynomial  */ 

fscanf (fp, "%d“,  &data_tmp_int) ; 

KEM_COAST_TURN_DEG  =  data_tmp_int ; 
fgets {descript,  80,  fp) ; 

P  (printf  ( ''kem_miss_poly_deg  (3 )  is%3d  %s", 
KEM_COAST_TURN_DEG,  descript) ; ) ; 

/*  Read  array  data  */ 

i=0; 

while{fscanf (fp, "%f",  &data_tmp)  !=  EOF) { 
kem_coast_turn_coeff [i]  =  data_tmp; 

fgets  {descript,  80,  fp)  ;  _  a.  ■ 

P {printf { "kem_coast_turn_coef f {%3d)  is%11.3f  %s  ,  i 

kem_coast_turn_coef f [ i ]  ,  descript);); 

++i; 

} 


fcXOS3(fp) / 

/*  END  DEFAULT  COAST  TURN  DATA  FOR  roiss_kem.c  READ  FROM  FILE 

num_kems  =  num_missiles ; 

kem_array  =  missile_array ; 

for  {i  =  0;  i  <  num_missiles;  i++) 

kern  array [i] .mptr. state  =  KEM_FREE; 

kem_array [ i] .mptr .max_f light_time  =  KEM_MAX_FLIGHT_TIM  ; 
kem_array[i] .mptr .max_turn_directions  =  1; 

} 

} 

int  missile_kem_is_f ree {  missile  ) 
int  missile; 

return{  {kem_array [missile] .mptr . state  ==  KEM_FREE  )); 

} 


/’ 


•k 


*  ROUTINE:  missile_kem_f ire  ^  ^ 

*  PARAMETERS:  kptr  -  A  pointer  to  the  KEM  missile  to  be 

*  fired.  ^ 

*  launch_point  -  The  location  in  world 

*  coordinates  that  the  missile  is 
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*  launched  from.  * 

*  loc_sight_to_world  -  The  sight  to  world 

*  transformation  matrix  used  * 

*  only  in  this  routine.  * 

*  launch_speed  -  The  speed  of  the  launch 

*  platform  (assumed  to  be  in  the  * 

*  direction  of  the  missile) .  * 

*  target_id  -  Target's  tracking  ID 

*  target_loc  -  location  of  target  in  World  Coord  * 

*  target_vehicle_id  -  The  vehicle  ID  of  the 

*  ■  target  (if  any) .  * 

*  RETURNS:  TRUE  if  successful,  FALSE  if  not.  * 

*  PURPOSE:  This  routine  performs  the  functions 

*  specifically  related  to  the  firing  of  a  KEM 

*  missile. 

★ 

!***************************************************************/ 

int  missile_kem_fire  (kptr,  launch_point,  loc_sight_to  world,  launch_speed, 

target_id,  target_loc,  target_vehicle_id) 

KEM_MISSILE  *kptr; 

VICTOR  launch_point; 

T_MATRIX  loc_sight_to_world; 

REAL  launch_speed; 
int  target_id; 

VECTOR  target_loc; 

VehiclelD  *target_vehicle_id; 


int  i-  A  counter.  */  . 

MISSILE '*n¥itr;  /*  Pointer  to  the  particular  generic  missile 

pointed  at  by  _kptr_.  */ 

int  comit._target_type;  /*  Indication  of  whether  target  is  known.  */ 


*  Find  _mptr_  and  _target_id_. 

*/ 

mptr  =  &(kptr-.>mptr)  ; 

if  ( target_vehicle_id  ==  0) 

kptr->target_vehicle_id. vehicle  =  vehicleirrelevant ; 

else 

kptr->target_vehicle_id  =  *target_vehicle_id; 
kptr->target_id  =  target_id; 
vec_copy (  target_loc,  kptr->target_pos  )  ; 


*  Set  the  initial  time,  location,  orientation,  and  speed  of  the  generic 

*  missile. 

*/ 

mptr->time  =0.0; 

vec_copy  ( launch_point ,  mptr->locatioin)  ; 
mat_copy  ( loc_sight_to_world,  mptr->orientation) ; 

mptr->speed  =  (missile_util_eval_pDly  (KEM_BURN_SPEED_DEG, 

kem_burn_speed_coeff,  0.0)  *  KEM_T0_MACH5_FACT0R)  +  launch_speed, 
mptr->init_speed  =  launch_speed; 
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if  {kptr->target_vehicle_id. vehicle  ==  vehicleirrelevant) 
comm_target_type  =  targetUnknown; 

else 

comm_target_type  =  targetlsVehicle; 

Tell  the  rest  of  the  world  about  the  firing  of  the  missile.  If  this 
cannot  be  done,  return  FALSE. 

if  ( !missile_util_comm_fire_missile  (mptr, 

map_get_ammo_entry_from_network_type  (munition_US_ADATS) , 

munition_US_ADATS,'  munition_US_ADATS ,  &  {kptr->target_vehicle_id)  , 

comm_target_type,  objectirrelevant,  0  /*tube*/)) 
return  (FALSE) ; 

If  all  was  successful,  fly  missile  in  guided  state. 

mptr->state  =  KEM_GUIDE; 
return  (TRUE) ; 


/**************************************************************** 

•  * 

*  ROUTINE;  missile_kem_update_guidance  .  . ,  ..u  4-  * 

*  PARAMETERS:  missile  -  An  index  to  the  KEM  missi  e  a 

*  is  to  be  updated.  ^ 

*  target_location  -  The  location  in  world 

*  coordinates  of  the  target 

*  RETURNS :  none  „  ,  * 

*  PURPOSE:  This  routine  updates  the  KEM's  target  s  ^ 

*  position  in  world  coordinates.  ^ 

I***************************************************************/ 

void  missile_kem_update_guidance(  missile,  target_location  ) 
int  missile; 

VECTOR  target_location; 

if(  kem_array [missile] .mptr .state  ==  KEM_GUIDE  )  .  ^  4 

vec_copy(  target_location,  kem_array [missile] . target_pos  ), 

} 

,**************************************************************** 

* 

★ 

*  ROUTINE;  missile_-kem_f ly  .  • ,  * 

*  PARAMETERS:  missile  -  An  index  to  the  KEM  missile  a 

*  is  to  be  flown  out.  * 

*  RETURNS:  none  .  ^ 

*  PURPOSE:  This  routine  performs  the  functions 
specifically  related  to  the  flying  a  KEM  * 


★ 

★ 


missile . 

w 


void  missile_kem_f ly (  missile  ) 
int  missile; 
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KEM_MISSILE  *kptr;  /*  A  pointer  to  a  KEM  missile  */  ,  ,  .  *, 

MISSILE  *mptr;  /*  A  pointer  to  the  generic  aspects  of  / 

REAL  time;  /*  The  current  time  after  launch  (ticks) .  / 

Set  _kptr_,  _mptr_  and  _time_.  These  values  are  created  mostly 
for  increased  readablity. 

kptr  =  &kem_array [missile] ; 
mptr  =  & (kptr->mptr) ; 
time  =  mptr->time; 

Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed  turn 
angles  in  each  direction.  The  equations  used  are  different  before  and 
after  motor  burnout . 

if  (time  <  KEM_BURNOUT_TIME) 

^  mptr->speed  =  {missile_util_eval_poly  {KEM_BURN_SPEED_DEG, 

]^em_burn_speed_coef f ,  time)  *  KEM_T0_MACH5_F ACTOR)  + 
mptr->init_speed; 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  (KEM_BURN_TURN_DEG, 
kem_burn_turn_coef f ,  time) ; 

} 

else 

^  mptr->speed  =  (missile_util_eval_poly  (KEM_COAST_SPEED_DEG, 

)^em_coast_speed_coef f ,  time)  *  KEM_T0_MACH5_F ACTOR)  + 
mptr->init_speed;  „„„„ 

mptr->cos_max_turn[0]  =  missile_util_eval_poly  {KEM_COAST_TURN_DEG, 
kem_coast_turn_coef f ,  time) ; 

} 

Find  the  target  point  =  Missile's  Target's  position  regardless  of  state 

if{  mptr->state  ==  KEM_GUIDE  II  mptr->state  ==  KEM_UNGUIDE  ) 
missile_target_point {  mptr,  kptr->target_pos  ) ; 

printf  { “MISSILE_KEM:  disallowed  missile  state  %d\n",  mptr->state) ; 

Try  to  actually  fly  the  missile.  If  this  fails  stop  the  missile  altogether 
and  return. 

'  if  { !missile_util_flyout  (mptr))  /*  checks  for  time  >  max_f light_time  */ 

{ 

missile_kem_stop  (kptr) ; 
return; 

} 

else 


If  the  missile  successfully  flew,  check  for  an  intersection  with  the 
ground  or  a  vehicle.  If  one  is  found,  blow  up  the  missile,  stop  i  s 
flyout  and  return. 
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if  {missile_util_comm_check_detonate  (mptr,  MSL_TYPE_MISSILE) ) 

inissile_kem_stop  {kptr)  ; 
return; 

} 

} 

/*/ 

*  If  the  missile  is  to  continue  to  fly,  return. 

/*/ 

return; 

} 


/ 


*  ROUTINE;  missile_kem_reset_missiles  ^ 

*  PARAMETERS:  none  ^ 

*  RETURNS:  none  .  o,,  * 

*  PURPOSE:  This  routine  puts  any  flying  missile  in  ^ 

*  unguided  state. 


void  missile_kem_reset_missiles  {) 

{ 

int  i  ; 

/*  .  ■ 

*  Reset  all  flying  missiles. 

*/  •  . 
for  (i  =  0;  i  <  num_kems;  i++) 

if{  kem_array[i] .mptr. state  ==  KEM_GUIDE  ) 

kem_array [ i ] . mptr . state  =  KEM_UNGUIDE ; 


} 


/**************************************************************** 

★ 

*  ROUTINE:  missile_kem_stop  *  Ho  t-o  * 

*  PARAMETERS:  kptr  -  A  pointer  to  the  KEM  missile  ^ 

*  be  stopped. 

*  RETURNS:  none  ,  _  ^  ^  * 

*  PURPOSE:  This  routine  causes  all  concerned  to  forge  ^ 

*  about  the  missile.  It  should  be  called  when 

*  the  flyout  of  any  KEM  missile  is  stopped  *  ^ 

*  {whether  or  not  it  has  exploded) . ^  Note  that  ^ 

*  this  routine  can  only  be  called  within  this 

*  module.  ^ 

!***************************************************************/ 


static  void  missile_kem_stop  (kptr) 

KEM_MISSILE  *kptr; 

{ 

Tell  the  world  to  stop  worrying  about  this  missile  then  release  the 
*  memory  for  use  by  other  missiles. 

/*/ 


-  H-13  - 


Reference  #  W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 

APPENDIX  H  -  miss_kein.c 

inissile_util_coinin_stop_inissile  {& (kptr->mptr )  ,  MSL_TYPE_MISSILE)  ; 
kptr->mptr . state  =  KEM_FREE; 
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The  following  appendix  contains  the  source  code  listing  for 
miss_maverck.c  for  convenience  in  docunaent  maintenance  and 
understanding  of  the  CSU. 
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/*  SHeader:  /a3/adst-cm/RWA/AIRNET/simnet/vehicle/libsrc/libmissile/RCS/miss_mav 

erck.c,v  1.4  1993/01/28  23:22:08  cm-adst  Exp  $  */ 

/* 

*  $Loq:  miss_maverck.c, V  5 

*  Revision  1.4  1993/01/28  23:22:08  cm-adst 

*  P.DesMeules  changss  for  spcr  31 

*  Revision  1.3  1993/01/06  21:13:31  cm-adst 

*  R. Branson's  changes  for  the  weapons  model. 

*  Revision  1.1  1992/09/30  16:39:52  cm-adst 

*  Initial  Version 

* 

.har  RCS  ID[]  =  "SHeader:  /a3/adst-cm/RWA/AIRNET/simnet/vehicle/libsrc/li 

1.4  19«/01,28  23,22:08  c„-adst  Exp  S', 


*  Revisions 


Version 

Date 

Author 

1.2 

10/23/92 

R.  Branson 

1.3 

10/30/92 

R .  Branson 

1.4 

11/25/92 

R .  Branson 

1.5 

01/19/93 

P . Desmeules 

Title 


SP/CR  Number 


zation 
ided  pathne 
directory 


fgets  to  make  sure  the 
whole  line  is  read  in. 


★ 

*  SP/CR  No.  Description  of  Modification 


Hard  coded  defines  changed  to  array  elements. 
Characteristics/parameter  data  array  added. 

Degree  of  polynomial  data  array  added.  ^ 

Added  file  reads  for  maverick  characteristics/ 

parameters,  burn  speed  coefficients,  and  coast 
speed  coefficients. 

Added  " /simnet/data/ “  to  each  data  file  pathname. 

*****************************/ 


/ 


■* 


*  FILE:  miss_maverick . c 

*  AUTHOR:  Bryant  Col lard 
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*  MAINTAINER: 

*  PURPOSE: 

* 

★ 

*  HISTORY: 

★ 

★ 


Bryant  Collard 

This  file  contains  routines  which  fly  out  a 
missile  with  the  characteristics  of  a  MAVERICK 
missile . 

12/8/88  bryant:  Creation 

4/24/89  bryant:  Added  static  memory  allocation. 
7/26/91  carol  :  libtrack/intervis  integration 


★ 

★ 

* 

* 

★ 

★ 

* 

★ 


*  Copyright  (c)  1988  BBN  Systems  and  Technologies,  Inc. 

*  All  rights  reserved. 


#include  "stdio.h" 
# include  "math.h" 


# include 
# include 
# include 
# include 
#5.nclude 
# include 
# include 
# include 


“sim_types .h" 
"sim_dfns .h" 
“basic .h“ 
“mun_type .h“ 

" libmap .h" 

"libmatrix.h" 

“libnear.h" 

" libtrack .h" 


#include  "miss_maverck .h" 


#include  “ libmiss_dfn .h" 
# include  “ libmiss_loc .h“ 


/* 

*  Debug  macro 
*/ 

#ifdef  FILEDBG 
ftdefine  P(a)  a 

#else 

#define  P(a) 

#endif 


/*/ 

*  Define  missile  characteristics. 
/*/ 


# define  MAVERICK_ARM_TIME 
#define  MAVERICK_BURNOUT_TIME 
# define  MAVERICK_MAX_FLIGHT_TIME 
#define  MAVERICK_LOCK_THRESHOLD 
# define  MAVERICK_HOLD_THRESHOLD 
# define  SPEED_0 
# define  THETA_0 


maverick_miss_char [  0 ] 

maverick_miss_char [  1] 
maverick_miss_char [  2] 

maverick_miss_char [  3] 
maverick_miss_char [  4] 
maverick_miss_char [  5] 
maverick_miss_char [  6] 


/*/ 

*  Set  parmeters  which  will  control  flight  trajectory  behavior 
/*/ 
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#define  SIN_UNGUIDE 
Sdefine  COS_UNGUIDE 
Sdefine  SIN_CLIMB 
Sdefine  C0S_CLIMB 
((define  SIN_L0CK 
Sdefine  COS_LOCK 
#define  C0S_TERM 
#define  COS_LOSE 


maver ick_miss_char [  7] 
maverick_miss_char [  8 ] 
maverick_miss_char [  9] 
maver ick_miss_char [10] 
maverick_miss_char [ 11 ] 
maverick_miss_char [ 12 ] 
maverick_miss_char [ 13 ] 
maverick_miss_char [ 14 ] 


*  Define  the  states  the  _MAVERICK_MISSILE_  can  be  in. 
/*/ 


#define  MAVERICK_FREE  0 
((define  MAVERICK_READY  1 
#define  MAVERICK_FLYING  2 


/*  No  missile  assigned.  */ 

/*  Missile  assigned  to  ready  state.  */ 
/*  Missile  assigned  to  flying  state.  */ 


/*/ 

★ 

★ 

t* 

/*/ 


The  following  terms  set  the  order  of  the  polynomials 
the  speed  or  cosine  of  the  maximum  allowed  turn  rate 
at  any  point  in  time. 


used  to  determine 
of  the  missile 


Sdefine  MAVERICK_BURN_SPEED_DEG  maverick_miss_poly_deg [ 0 ] 
#define  MAVERICK_COAST_SPEED_DEG  maverick_miss_poly_deg[l] 


^ Maverick  missile  characteristic  parameters  initialized  to  default  values 
/*/ 

static  REAL  maver ick_miss_char [15]  = 


{ 


20.0, 

22.5, 

900.0, 

0.989073800, 

0.969846310, 

28.33333333, 

0.046542113, 

0.0, 

1.0,  /* 
0.004072424, 
0.999991708, 
0.087155743, 
0.996194698, 
0.173648178, 
0.939692621 


/*  maverick  arm  time  ticks  {1.3  sec)  */  ^ 

/*  maverick  burnout  time  ticks  (1.5  sec)  / 

/*  maverick  max  flight  time  ticks  (60  sec)  */ 

/*  maverick  lock  threshold  cos  (6  deg)  **  2  / 
/*  maverick  hold  threshold  cos  (10  deg)  **  2  */ 
/*  speed_0  */ 

/*  theta_0  */ 

/*  sin  level  unguided  flight.  */ 
cos  level  unguided  flight.  */ 

/*  sin  climb  3.5  deg/sec  */ 

/*  cos  climb  3.5  deg/ sec  */ 

/*  sin  lock  5  deg  */ 

/*  cos  lock  5  deg  */ 

/*  cos  terminal  80  deg  */ 

/*  cos  loose  lock  20  deg  */ 


); 


*  The  following  terms  set  the  order  of  the  polynomials  used  to  determine 

*  the  speed. 

/*/ 

static  int  maverick_miss_poly_deg [2]  = 

/*  Maverick  burn  speed  degree.  */ 
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}; 


3 


/*  Maverick  coast  speed  degree.  */ 


coefficients  for  the  speed  polynomial  before  motor  burnout 

/*/ 


static  REAL  maverick_burn_speed_coef f [5] 


0.03333333, 

1.25777777 


/*  a_0 
/*  a_l 


-  m/tick  (67.0  m/sec)  */ 

-  m/tick**2  (274.9732662  m/sec 


**2)  */ 


); 


Coefficients  for  the  speed  polynomial  after  motor  burnout 

/*/ 


REAL  maverick_coast_speed_coef f [5] 


static 

{ 

30.46972849, 

'  -9 .7721160e-2, 

1.2433925e-4, 
-5.4061501e-8 


/*  a_0  -  m/tick 
/*  a_l  -  m/tick**2 
/*  a_2  -  m/tick**3 
/*  a_3  -  m/tick**4 


(327.2858074  m/sec)  */ 
(-21.4609544  m/sec**2)  */ 
(0.8227650  m/sec**3)  */ 
(-0.0133200  m/sec**4)  */ 


); 


/*/ 

*  Memory  for  the  missiles  is  declared  in 

*  initialization,  a  pointer  is  assigned 

*  issues  are  dealt  with  in  this  module. 

/*/ 

static  MAVERICK_MISSILE  *maverick_array ; 
static  int  num_mavericks ; 


vehicle  specific  code.  During 
to  this  memory  then  all  memory 


/*  A  pointer  to  missile  memory.  / 

/*  The  number  of  defined  missiles.  / 


# define  STRING_LEN  20 

static  char  prelaunch_intervis_method 
static  char  in_f light_intervis_method 
static  PFI  pel_callback_func; 

static  REAL  maverick_cone_threshold; 


[STRING_LEN  +  1] 
[STRING_LEN  +  1] 


“lrf“  ; 

"omniscient" ; 


/*/ 

*  Declare  static  functions. 
/*/ 


static  void  missile_maverick_f ly  ()  ,  _  fr-om  spnsor  id  (' 

static  MAVERICK_MISSILE  *missile_maverick_get_missil  _ 

static  void  missile_maverick_lock_handler  (), 

static  void  missile_maverick_break_lock_handler  (), 

static  REAL  missile_maverick_detectibility  ( ) ; 

static  void  missile_maverick_object_update  ( ) ; 


/ 


★ 


*  ROUTINE:  missile_maverick_init  =T-T-av  of 

*  PARAMETERS:  missile_array  -  A  pointer  t 
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MAVERICK  missiles  defined  in  * 
vehicle  specific  code. 

num_missiles  -  The  number  missiles  defined  in  * 
missile_array_. 

* 

*  RETURNS:  none  * 

*  PURPOSE:  This  routine  copies  the  parameters  in  .  .  * 

*  variables  static  to  this  module  and  initializes  ^ 

*  the  state  of  all  the  missiles. 

;***************************************************************/ 

void  missile_maverick_init  {missile.array ,  num_missiles,  func) 
MAVERICK_MISSILE  missile_array [ ] ; 
int  num_missiles; 

PFI  func; 

^  int  i;  /*  A  counter.  */ 
int  data_tmp_int; 
float  data_tmp; 
char  descript [80] ; 

,  FILE  *fp; 

P(printf {"$$$$  MAVERICK  missile  file  data  $$$$\n“);); 

/*  DEFAULT  CHARACTERISTICS  DATA  FOR  miss_maverck . c  READ  FROM  FILE 

fp  =  f open { " /s imnet /data/ras_mk_ch . d  ,  x  ), 

if(fp  "Cannot  open  /s imnet /data/ms_mk_ch.d\n  )  ; 

exit { ) ; 

} 


/* 

/* 


rewind (fp) ; 

/*  Read  array  data  */ 
i=0; 

while{fscanf  (fp, ''%f",  &data_tmp)  !=  EOF)  { 
maverick_miss_char [ i]  =  data_tmp; 
fgets (descript,  80,  fp) ; 

P(printf ("maverick_miss_char(%3d)  is%11.3f  %s  , 
maverick_miss_char [ i] ,  descript) ; ) ; 

++i; 

} 

ENd'^DEFAuS^  CHARACTERISTICS  DATA  FOR  miss_maverck .  c  READ  FROM  FILE  */ 


DEFAULT  BURN  SPEED  DATA  FOR  miss_mavercl^ . c  READ  FROM  FILE 

fp  =  fopen ( “ /simnet/data/ms_mk_bs .d" , "r " ) ; 

If  (fp-_WLLH  (std^rr^  "Cannot  open  /simnet/data/ms_mk_bs  . d\n“ )  ; 
exit ( ) ; 

} 


rewind (fp) ; 
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/*  Read  degree  of  polynomial  */ 

fscanf {fp, "%d“ ,  &data_tmp_int) ; 
MAVERICK_BURN_SPEED_DEG  =  data_tiiip_int; 
fgets {descript,  80,  fp) ; 

PIprintf  (''maverick_miss_poly_deg(0)  is%3d  %s'' 
MAVERICK_BURN_SPEED_DEG,  descript) ; ) ; 


/*  Read  array  data  */ 


while(fscanf  (fp, ''%f",  &data_tmp)  _  !=  EOF)  { 

maverick_burn_speed_coef f [i]  =  data_tmp; 

fgets  (descript,  80,  fp); 

P(printf  { "maverick_burn_speed_coeff  (%3d)  is%11.3f  -ss  ,  i, 

maverick_burn_speed_coef f [ i] ,  descript) ; ) ; 

++i; 


f  0 1 OS  G ( f p )  / 

/'*  END  DEFAULT  BURN  SPEED  DATA  FOR  miss_maverck .  c  READ  FROM  FILE  */ 
/*  DEFAULT  COAST  SPEED  DATA  FOR  miss_»averck .  c  READ  FROM  FILE 

fp  =  fopen ( " /simnet/data/ms_mk_cs.d" ,  ‘r  )  ; 

if (fp==NULL) {  .  ,  ,  ov 

fprintf (stderr,  "Cannot  open  /simnet/data/ms_mk_cs . a\n  ; ; 

exit { ) ; 

} 


rewind (fp) ; 

/*  Read  degree  of  polynomial  ■*/ 


fscanf (fp."%d",  &data_tmp_int) ; 
MAVERICK_COAST_SPEBD_DEG  =  data_tmp_int; 
fgets {descript ,  80,  fp) ; 

P  (print f  { ''maverick_miss_poly_deg(l)  is%3d  %s'' 
MAVERICK_COAST_SPEED_DEG,  iescript) ; ) ; 


*/ 


/*  Read  array  data  */ 
i=0; 

while{fscanf  (fp, &data_tmp)  !=  EOF)  { 

maverick_coast_speed_coef fli]  =  data_tmp; 

fgets  {descript,  80,  fp)  ;  •  an  of  a.  ..  i 

P(printf  ( "maverick_coast_speed_coeff  (%3d)  is%ll.Bt  %s  , 
maverick_coast_speed_coeff [i] ,  descript) ; ) ; 

++i; 

} 


/*  ENd'^DEFAULT^  COAST  SPEED  DATA  FOR  iKS3_maverck .  c  READ  FROM  FILE  */ 


maverick_cone_thresholc'  -  MA'/ERICK.LOCK_THRESHOLD; 
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num_mavericks  =  nuit\_missiles; 
inaverick_array  =  niissile_array  ; 


} 


for  (i  =  0;  i  <  nuiti_inissiles ;  i++) 


{ 


maverick_array[i]  .mptr. state  -  max  ft  TGHT  TIME- 

maverick_array [i] .mptr .max_f light_time  _  =  MAVERICK_MAX_FLIGHT_TIME, 

maverick_array [ i] .mptr .max_turn_directions  =  1, 

maverick_array[i] .object_being_tracked  =  NO_OBJECT; 
maverick_array [i] .sensor_id  =  NULL; 


} 

pel_callback_func  =  func; 


/**************************************************************** 

•  * 

★  ^ 

*  ROUTINE;  missile_maverick_sensor_init  ^ 

*  PARAMETERS:,  none  ^ 

*  RETURNS;  none  , 

*  PURPOSE:  Calls  to  initialize  a  libtrack  sensor 

-!***************************************************************/ 
void  missile_maverick_sensor_init  (mvptr,  iv_method) 
MAVERICK_MISSILE  *mvptr; 
char  *iv_method; 


if  (TrackSensorlnit  (missile_maverick_lock_handler, 
miss i le_maver ick_break_lock_handler , 
missile_maverick_detectibility , 

pel_callback_f unc , 

missile_maverick_object_update , 

E_NAN0, 

Scmvptr  ->  sensor_id)  <  0)  ^  a.  <  „ 

printf  ( "missile_maverick_sensor_init :  TrackSensorlnit:  s\n  , 

TrackErrString  ( ) ) ; 


0) 


if 


{TrackSetIntervisibility  (mvptr  ->  sensor_id,  prelaunch_intervis_method)  < 
printf  C'missile.maverick.sensor.init:  TrackSetIntervisibility:  %s\n", 

TrackErrString  ( ) ) ; 


if  (TrackSetPersistence  (mvptr  ->  sensor_id,  5  /*  ticks  of  persistence  */) 

^  printf  (“missile_maverick_sensor_init:  TrackSetPersistence:  %s\n“ , 
TrackErrString  ( ) )  ; 


) 


if 


(TrackSetMaxResponses  (mvptr  ->  sensor_ 

printf  ( "missile_maverick_sensor_init : 

TrackErrString  ( ) ) ; 


id,  1)  <  0) 

TrackSetMaxResponses : 


%s\n" , 


if 


(TrackSetVehiclelD  (mvptr  ->  sensor_id, 
printf  ( "missile_maverick_sensor_init: 

TrackErrString  ()); 


network_get_vehicle_id  {))  <  0) 

TrackSetVehiclelD:  %s\n'', 
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*  ROUTINE:  missile_maverick_ready  ^ 

*  PARAMETERS:  none  _  _  ,  * 

*  RETURNS:  A  pointer  to  a  missile  that  is  currently 

*  PURPOSE:  This  routine  finds,  if  possible,  a  missile  that 

*  is  not  being  used,  puts  it  in  a  ready  state  and 

*  returns  a  pointer  to  it. 


/ 


MAVERICK_MISSILE  *missile_maverick_ready  '() 


{ 

int  i; 


/*  A  counter.  */ 


/*/ 

*  Try 
/*/ 

for 

{ 

/,*/ 


/*/ 


to  find  a  free  missile. 

(i  =  0;  i  <  num_mavericks;  i++) 

If  a  free  missile  is  found,  put  it  in  a  ready  state,  clear  the  target 
ID  and  return  a  pointer  to  it. 

if  {maverick_array[i] .mptr .state  ==  MAVERICK_FREE) 
maverick_array[i] .mptr. state  =  MAVERICK_READY; 

maverick_array [i] . target_vehicle_id. vehicle  =  vehiclelrrelevant ; 
missile_maverick_sensor_init  {&maverick_array [ i] , 

prelaunch_intervis_method) ; 

return  {&maverick_array(i] ) ; 


/*/ 


} 

) 

If  no  free  missile  is  found,  return  a  NULL  pointer. 


/*/ 

return  (NULL) ; 

} 


★ 

★ 

★ 

★ 

* 

★ 

★ 

★ 

★ 

* 

* 

★ 

★ 


ROUTINE:  missile_maverick_pre_launch 

PARAMETERS:  mvptr  -  A  pointer  to  the  missile  that  is  to  be 

serviced.  * 

launch_point  -  The  location  of  the  missile  in 
world  coordinates.  * 

launch_to_wor Id  -  The  transformation  matrix  of 

the  missile  to  the  world.  * 

veh_list  -  Vehicle  list  ID. 

RETURNS:  none 

PURPOSE:  This  routine  is  called  after  a  missile  has  been  ^ 
readied  and  before  it  has  been  launched.  It 
determines  if  the  seeker  head  can  see  a  target 
and,  if  it  can  see  a  target,  stores  its  * 


★ 
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*  position. 

****************************************************************/ 
void  inissile_maverick_pre_launch  (mvptr,  launch_point ,  launch_to_world, 
veh_list) 

MAVERICK_MISSILE  *mvptr; 

VECTOR  launch_point; 

T_MATRIX  launch_to_world; 
int  veh_list; 

{ 

register  TObjectP  object; 

VECTOR  object_loc; 

1*1 

*  tick  libtrack  to  update  location  and  see  if  any  callbacks  need  to  be 

*  invoked. 

/*/  .  • 

if  (TrackUpdate  {mvptr  ->  sensor_id,  veh_list,  launch_point, 

launch_to_world[l] )  <  0) 

printf  (“missile_maverick_pre_launch :  TrackUpdate:  %s\n  , 
TrackErrString  { ) } ; 

*  If  a  target  is  found,  store  its  location. 

/*/ 

if  ((object  =  mvptr  ->  object_being_tracked)  !=  NO_OBJECT) 

mvptr->target_vehicle_id  =  object  ->  var .vehiclelD; 
GetLocationOfTObject  (object,  object_loc) ; 

/*  change  pursuit  to  take  a  VECTOR  rather  than  VAP  for  location  / 
missile_target_pursuit  (& (mvptr->mptr) ,  object_loc) ; 

} 

else 

mvptr->target_vehicle_id . vehicle  =  vehicleirrelevant , 
if  (TrackAcquire  (mvptr  ->  sensor_id,  veh_list,  launch_point , 
launch_to_world[l] )  <  0) 

printf  { "missile_maverick_pre_launch:  TrackAcquire:  %s\n", 
TrackErrString  () ) ; 

} 

) 

/**************************************************************** 


ROUTINE:  missile_maverick_f ire  * 

PARAMETERS:  mvptr  -  A  pointer  to  the  MAVERICK  missile  that 

is  to  be  launched.  * 

launch_point  -  The  location  in  world 

coordinates  that  the  missile  is  * 

launched  from.  * 

launch_to_world  -  The  transformation  matrix  of 

the  launch  platform  to  the  * 
world.  * 

launch_speed  -  The  speed  of  the  launch 

platform  (assumed  to  be  in  the  * 
direction  of  the  missile) .  * 
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*  tube  -  The  tube  the  missile  was  launched  from.  * 

*  RETURNS:  TRUE  for  a  successful  launch  and  FALSE  for  an  * 

*  unsuccessful  launch. 

*  PURPOSE:  This  routine  performs  the  functions  * 

*  ■  specifically  related  to  the  firing  of  a  * 

*  MAVERICK  missile.  * 


int  missile_maverick_f ire  (mvptr,  launch_point,  launch_to_world,  launch_speed, 
tube) 

MAVERICK_MISSILE  *mvptr; 

VECTOR  launch_point; 

T_MATRIX  launch_to_world; 

REAL  launch_speed; 
int  tube; 

^  MISSILE  *mptr;  /*  Pointer  to  the  particular  generic  missile 

pointed  at  by  _mvptr_.  */ 

/*/ 

,*  Get  a  pointer  to  the  generic  elements  of  the  MAVERICK  missile.  This 

*  improves  code  readability . 

/*/ 

mptr  =  & {mvptr->mptr) ; 

/*/ 

*  Set  the  initial  time,  location,  orientation,  and  speed  of  the  generic 

*  missile. 

/*/ 

mptr->time  =0.0; 

vec_copy  ( launch_point ,  mptr->location) ; 
mat_copy  { launch_to_world,  mptr->orientation) ; 

mptr->speed  =  missile_util_eval_poly  {MAVERICK_BURN_SPEED_DEG, 
maver ick_burn_speed_coef f ,  0.0)  +  launch_speed; 

mptr->init_speed  =  launch_speed; 

/*/ 

*  Tell  the  rest  of  the  world  about  the  firing  of  the  missile.  If  this 

*  cannot  be  done,  release  the  missile  memory  and  return  FALSE. 

/*/ 

if  { !missile_util_comm_f ire_missile  (mptr,  MSL_TYPE_MISSILE, 

map_get_ammo_entry_f rom_network_type  (munition_US_Maverick) , 
munition_US_Maverick,  munition_US_Maverick, 

& {mvptr->target_vehicle_id) ,  targetlsVehicle,  objectirrelevant, 
tube) ) 

{ 

mptr->state  =  MAVERICK_FREE; 
return  (FALSE) ; 

} 

/*/ 

*  If  all  was  successful,  set  the  missile  state  to  MAVERICK_FLYING  and 

*  return  TRUE. 

/*/ 

mptr->state  =  MAVERICK_FLYING; 
return  (TRUE) ; 

} 
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*  ROUTINE:  inissile_inaverick_f ly_missiles 

*  PARAMETERS:  veh_list  -  Vehicle  list  ID.  ^ 

*  RETURNS :  none  _  .... 

*  PURPOSE:  This  routine  flies  out  all  missiles  in  a 

*  flying  state. 


★ 


void  missiIe_maverick_flY_missiles  (veh_Iist) 

int  veh_Iist; 

int  i;  /*  A  counter.  */ 

/*/  .  . 

*  Fly  out  all  flying  missiles. 

for  (i  =  0;  i  <  num_mavericks ;  i++) 

,  ^  if  {maverick_array[i].mptr. state  ==  MAVERICK.FLYING) 

missile_maverick_fly  (&{maverick_array [i] ) ,  veh_list) ; 

} 

} 


/ 


*  ROUTINE:  missile_maverick_f ly  .  .  * 

*  PARAMETERS:  mvptr  -  A  pointer  to  the  MAVERICK  missile 

*  is  to  be  flown  out.  *  ^ 

*  veh_list  -  Vehicle  list  ID. 

*  RETURNS:  none  .  *  ^ 

*  PURPOSE:  This  routine  performs  the  functions  ^ 

*  specifically  related  to  the  flying  a  MAVERICK 

*  missile. 

★ 

!***************************************************************/ 


static  void  missile_maverick_f ly  (mvptr,  veh_list) 

MAVERICK_MISSILE  *mvptr; 
int  veh_list; 

^  register  MISSILE  *mptr;  /*  A  pointer  to  the  generic  aspects  of 

_m-vptr_.  */ 

pc’aT  finiP-  /*  The  current  time  after  launch  (ticks). 

VECTOR  target_.locat ion;  /*  The  location  of  the  g 

Set_mptr_  and  _time_.  These  values  are  created  mostly  for  increased 
*  readablity. 

/*/ 

mptr  =  & (mvptr->mptr) ; 
time  =  mptr->time; 


*/ 


/*/ 

★ 

★ 


Find  the  current  missile  speed  and  the  cosine  of 
angle.  The  equations  used  are  different  before 


the  maximum  allowed  turn 
and  after  motor  burnout. 
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if  (time  <  MAVERICK_BURNOUT_TIME) 

^  mptr->speed  =  missile_util_eval_poly  {MAVERICK_BURN_SPEED_DEG, 
maverick_burn_speed_coef f ,  time)  +  mptr->init_speed; 

} 

else 

mptr->speed  =  missile_util_eval_poly  (MAVERICK_COAST_SPEED_DEG, 
maverick_coast_speed_coef f ,  time)  +  mptr->init_speed; 


Note  that  this  is  a  temporary  method  of  finding  turn  angle. 

mptr->cos_max_turn[0]  =  cos  (sqrt  (mptr->speed  /  (SPEED_0  + 
mptr->init_speed) )  *  THETA_0) ; 

if  (TrackUpdate  (mvptr  ->  sensor_id,  veh_list,  mptr  ->  location, 

mptr  ->  orientation [ 1] )  <  0)  . 

printf  { “missile_maverick_fly :  TrackUpdate:  %s\n",  TrackErrString  ()), 

Find  the  target  point  to  which  the  missile  is  to  fly.  The  missile  ignores 
any  targets  until  it  is  armed. 

if  (time  <  MAVERICK_ARM_TIME) 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS.UNGUIDE,  SIN_CLIMB, 
COS_CLIMB,  SIN_LOCK,  COS_LOCK,  C0S_TERM,  COS_LOSE) ; 

else 

TObjectP  object  =  mvptr  ->  object_being_tracked; 

Try  to  find  a  target.  If  one  is  found,  fly  towards  it  in  the 
proper  trajectory,  otherwise,  fly  in  a  search  trajectory. 

if  (object  !=  NO_OBJECT) 

{ 

VECTOR  target_location; 

GetLocationOfTObject  (object,  target_location) ; 

mvptr->target_vehicle_id  =  object  ->  var . vehiclelD; 
missile_target_agm  (mptr,  target_location,  SIN_UNGUIDE, 

COS_UNGUIDE,  SIN_CLIMB,  COS_CLIMB,  SIN_LOCK,  COS_LOCK, 
COS_TERM,  COS_LOSE) ; 

) 

else 

mvptr->target_vehicle_id. vehicle  =  vehicleirrelevant , 

if  (TrackAcquire  (mvptr  ->  sensor_id,  veh_list,  mptr  ->  location, 
mptr  ->  orientation [1] )  <  0) 
printf  ( ''missile_maverick_f  ly :  TrackAcquire:  %s\n  , 
TrackErrString  ( )  )  ; 

missile_target_agm  (mptr,  NULL,  SIN_UNGUIDE,  COS_UNGUIDE, 

SIN_CLIMB,  COS_CLIMB,  SIN_LOCK,  C0S_L0CK,  C0S_TERM, 
COS_LOSE) ; 
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/*/ 


/*/ 


Try  to  actually  fly  the  missile.  If  this  fails  stop  the  missile  altogether 
and  return. 

if  ( !missile_util_flyout  (mptr)) 


missile_maverick_stop  (mvptr); 
return; 


} 

else 

{ 


/*/ 


/*/ 


If  the  missile  successfully  flew,  check  for  an  intersection  with  the 
ground  or  a  vehicle.  If  one  is  found,  blow  up  the  missile,  stop  its 

flyout  and  return. 

if  {missile_util_comm_check_intersection  {mptr,  MSL_TYPE_MISSILE) ) 

^  missile_util_comm_check_detonate  (mptr,  MSL_TYPE_MISSILE) ; 
missile_maverick_stop  (mvptr) ; 
return; 

) 


} 


/*/ 

★ 

/*/ 

} 


If  the  missile  is  to  continue  to  fly,  return, 
return; 


/ 


**************************************************************** 

★ 

★ 

*  ROUTINE;  missile_maverick_stop  ^ 

*  PARAMETERS:  mvptr  -  A  pointer  to  the  MAVERICK  missi  e 

*  is  to  be  stopped. 

*  RETURNS:  none  .  *  e  ^  * 

*  PURPOSE;  This  routine  causes  all  concerned  to  forge  ^ 

*  about  the  missile.  It  should  be  called  when  ^ 

*  the  flyout  of  any  MAVERICK  missile  is  stopped 

*  (whether  or  not  it  has  exploded) . 

!***************************************************************/ 


void  missile_maverick_stop  (mvptr) 

MAVERICK_MISSILE  *mvptr; 

{ 

^*^  If  the  world  has  been  told  to  worry  about  this  missile,  tell  it  to  stop 
*  then  release  missile  memory  for  use  by  other  missiles. 


/*/ 


if  (mvptr->mptr . state  ==  MAVERICK_FLYING) 

missile_util_comm_stop_inissile  {& (mvptr->mptr)  , 
mvptr->mptr. state  =  MAVERICK_FREE; 

TrackSensorUnInit  (mvptr  ->  sensor_id) ; 


MSL_TYPE_MISSILE) ; 


mvptr  ->  sensor_id  =  NULL; 

mvptr  ->  object_being_tracked  =  NO_OBJECT; 


/*  perhaps  call  break  lock? 


*/ 
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} 


static  MAVERICK_MISSILE  *missile_maverick_get_missile_from_sensor_id  (sensor_id) 
int  sensor_id; 

^  register  MAVERICK_MISSILE  *mvptr  =  maverick_array ; 
register  int  i; 

for  (i  =  0;  i  <  num_mavericks ;  i++,  mvptr++) 

{ 

if  {mvptr  ->  sensor_id  ==  sensor_id) 
return  (mvptr) ; 

} 

return  (NULL) ; 

} 

static  void  missile_maverick_lock_handler  (sensor_id,  object) 
int  sensor_id; 

TpbjectP  object; 

{ 

MAVERICK_MISSILE  *mvptr; 

if  (object  ==  NO_OBJECT) 

if  (TrackDontLock  (sensor_id,  object)  .  <  0) 

printf  ( "Maver ickLockHandler :  TrackDontLock:  %s\n  , 

TrackErrString  { ) ) ; 

return; 

) 

if  ((mvptr  =  missile_maverick_get_missile_from_sensor_id  (sensor_id) ) 

!=  NULL) 

/*  already  tracking  an  object,  but  because  of  the  delay  from  the  TrackAqcuire 
call,  the  lock  handler  has  been  invoked  again.  It  does  not  matter  if  it  is 
the  same  object  or  not  as  before.  Just  do  not  lock  again  / 

if  (mvptr  ->  object_being_tracked  !=  N0_0BJECT) 

if  (TrackDontLock  (sensor_id,  object)  <  0) 

printf  { "MaverickLockHandler :  TrackDontLock:  %s\n", 
TrackErrString  ( ) ) ; 

return; 

} 

mvptr  ->  object_being_tracked  =  object; 

if  (TrackLock  (sensor_id,  object)  <  0)  . 

printf  ("MaverickLockHandler:  TrackLock:  %s\n",  TrackErrString  ()), 

} 

else 

printf  (“LockHandler:  No  missile  for  Sensorld  %d\n",  sensor_id) ; 
if  (TrackDontLock  (sensor_id,  object)  <  0) 
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printf  { "MaverickLockHandler :  TrackDontLock :  %s\n", 

TrackErrString  ()); 

} 

} 

static  void  missile_maverick_break_lock_handler  {sensor_id,  object) 
int  sensor_id; 

TObjectP  object; 

{ 

register  MAVERICK_MISSILE  *mvptr; 
if  (object  ==  NO_OBJECT) 

return;  _ 

if  {  (mvptr  =  inissile_maverick_get_inissile_f rom_sensor_id  (sensor_id)  ) 

!=  NULL) 

if  (mvptr  ->  object_being_tracked  ==  NO_OBJECT) 

printf  ( “MaverickBreakLockHandler :  BREAK  LOCK  BUT  NOT  LOCKED  !!!\n  ); 
return; 

} 

if  (mvptr  ->  object_being_tracked  !=  object) 

printf  ("MaverickBreakLockHandler:  BREAK  LOCK  ON  UNKNOWN  OBJECT! !!\n  ); 
return; 

} 

if  (TrackBreakLock  (sensor_id,  object)  <  0)‘ 

printf  ("MaverickBreakLockHandler:  TrackBreakLock:  %s\n“, 

TrackErrString  ()); 

mvptr  ->  object_being_tracked  =  NO_OBJECT; 

} 

printf  ( "BreakLockHandler :  No  missile  for  Sensorld  %d\n",  sensor_id) ; 


static  REAL  missile_maverick_detectibility  (sensor_id,  object,  mav_loc 

mav_boresight , 
flags) 

int  sensor_id; 

TObjectP  object; 

VECTOR  mav_loc; 

VECTOR  mav_boresight; 
int  flags; 

{ 

REAL  detectibility; 

VECTOR  target_location; 

VECTOR  to_target; 

REAL  dotProduct; 

MAVERICK_MISSILE  *mvptr; 


/*  Get  location  of  object  */ 

GetLocationOfTObject  (object,  target_location) ; 
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/*  Determine  detectibility .  This  is  the  cosine  squared  of  the  angle 

*  between  a  vector  from  the  sensor  to  the  object  and  the  bores ight  of 

*  the  sensor  (for  now) . 

*/ 

/*  Some  of  these  computations  may  be  duplicated  in  the  tracking  package. 

*  May  provide  object  calls  to  get  them  if  that  is  more  efficient. 

*/ 

vec_sub  {target_location,  mav_loc,  to_target) ; 
dotProduct  =  vec_dot_prod ' (mav_boresight,  to_target) ; 
detectibility  =  sign  (dotProduct)  *  dotProduct  *  dotProduct  / 
vec_dot_prod  (to_target,  to_target) ; 


/*  if  the  object  is  outside  the  detection  cone  of  the  sensor, 
*  return  a  detectibility  of  0 . 

*/ 


if  { (mvptr  =  missile_maverick_get_«issile_from_sensor_id  (sensor_id) ) 

!=  NULL)' 

{ 

'  switch  (mvptr  ->  mptr. state) 

{ 

case  MAVERICK_READY : 

maverick_cone_threshold  =  MAVERICK_LOCK_THRESHOLD; 
break; 

case  MAYERICK_FLYING: 

maverick_cone_threshold  =  MA'9ERICK_H0LD_THRESH0LD; 
break; 

case  MAVERICK_FREE : 

printf  ( "MaverickDetectibility :  Maverick  not  READY  or  FLYING\n  ), 

maverick_cone_threshold  =  MATERICK_LOCK_THRESHOLD; 

break; 

} 

if  (detectibility  <  maverick_cone_threshold) 
detectibility  =  0.0; 

) 

else 

printf  ("MaverickDetectibility:  no  missile  for  sensorlD  %d\n", 
sensor_id) ; 

} 

return  (detectibility) ; 

} 

static  void  missile_maverick_object_update  () 

{ 

} 


/* 

*  MissileMaverickSetPrelaunchIntervisibility 
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*  Called  from  command  line  switch  processing  code  to  set  the  intervisibility 

*  interface  to  use  and  the  way  to  init  it. 

void  missile_maverick_set_prelaunch_intervisibility_mode  (mode) 

char  *mode; 

if  (strlen  (mode)  >  STRING_LEN) 

^  printf  { "missile_maverick_set_prelaunch — intervisibility:  type  string  too 

long\n" ) ; 

return; 

strcpy  {prelaunch_intervis_method,  mode) ; 

) 

/*  .... 

*  MissileMaverickSetLaunchedIntervisibility 

*  Called  from  command  line  switch  processing  code  to  set  the  intervisibility 

*  interface  to  use  and  the  way  to  init  it . 

'■*  j 

void  missile_maverick_set_launched_intervisibility_mode  (mode) 

char  *mode; 

if  (strlen  (mode)  >  STRING_LEN) 

^  printf  ( "missile_maverick_set_launched — intervisibility:  type  string  too 

longXn") ; 

return; 

} 

strcpy  (in_f light_intervis_method,  mode) ; 

} 

is_maverick_f lying  (sensor_id) 
register  int  sensor_id; 

{ 

register  int  i; 

for  (i  =  0;  i  <  num_maver icks ;  i++) 

if  (maverick_array [ i] . sensor_id  ==  sensor_ia) 

if  (maverick_array [ i] .mptr . state  ==  MAVERICK_FLYING) 

return  (TRUE) ; 

else 

return  (FALSE) ; 

} 

) 

return  (FALSE) ; 

} 

static  void  ( *sensor_uninit_func)  (); 
void  sensor_uninit_callback  (sensor_id) 
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int  sensor_id; 

( *sensor_uninit_func )  (); 

} 


missile_maverick_prepare_to_uninit_seeker  (mvptr,  uninit_func) 

MAVERICK_MISSILE  *mvptr; 
void  (*uninit_func)  (); 


{ 

} 


sensor_uninit_func  -  uninit_func, 
TrackSensorUnInitPrep  {mvptr  ->  sensor_id. 


sensor_uninit_callback) ; 


I 
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Appendix  J  -  Source  code  listing  for  miss_nlos.c. 

The  following  appendix  contains  the  source  code  listing  for 
miss_nlos.c  for  convenience  in  document  maintenance  and 
understanding  of  the  CSU. 
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/*  SHeader :  /a3/adst-cm/RWA/AIRNET/siinnet/vehicle/libsrc/libmissile/RCS/miss_nlo 

s.c,v  1.4  1993/01/28  23:22:08  cm-adst  Exp  $  */ 

/* 

*  $Log:  miss_nlos .c, V  $ 

*  Revision  1.4  1993/01/28  23:22:08  cm-adst 

*  P.DesMeules  changes  for  spcr  31 

* 

*  Revision  1.3  1993/01/06  21:13:50  cm-adst 

*  R.Branson's  changes  for  the  weapson  model. 

* 

*  Revision  1.1  1992/09/30  16:39:52  cm-adst 

*  Initial  Version 

* 

cjtatic  char  RCS  ID[]  =  "$Header:  /a3/adst-cm/RWA/AIRNET/simnet/vehicle/libsrc/li 

£s;ile/RCS/miIs_nlos.c,v  1.4  1993/01/28  23:22:08  cm-adst  Exp 

****************************************** 


★ 

*  Revisions 

★ 
it 
★ 
ie 
★ 

★ 

★ 

* 

★ 

* 
ie 
* 

★ 


Version 

Date 

Author 

1.2 

10/23/92 

R. 

Branson 

1.3 

10/30/92 

R. 

Branson 

1.4 

11/25/92 

R, 

,  Branson 

1.5 

01/19/93 

P, 

.  Desmeules 

Title 


SP/CR  Number 


zation 
Jded  pathnc 
directory 


31 


fgets  to  make  sure  the 

,  whole  line  is  read  in. 

*****************************************************************************^ 

/***************************************************************************** 

ilr 

*  SP/CR  No.  Description  of  Modification 

★  _ _  "" 

* 

★ 

★ 

* 

★ 

★ 

★ 

★ 

★ 


Hard  coded  defines  changed  to  array  elements. 
Characteristics/parameter  data  array  added. 

Degree  of  polynomial  data  array  added. 

Added  file  reads  for  NLOS  characteristics/ 

parameters,  burn  speed  coefficients,  and  coast 
speed  coefficients. 

Added  " /simnet/data/ "  to  each  data  file  pathname. 


/ 


**************************************************************** 

★ 

★ 

★ 

*  FILE:  miss_nlos.c  ^ 

*  AUTHOR:  Bryant  Collard 
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*  MAINTAINER: 

*  PURPOSE: 

* 

★ 

*  HISTORY: 

★ 

•k 


Bryant  Collard 

This  file  contains  routines  which  fly  out  a 
missile  with  the  characteristics  of  a  NLOS 
missile . 

11/25/88  bryant:  Creation 
4/24/89  bryant:  Added  static  memory  allocation 
05/17/89  dan:  changed  hellfire  to  nlos 


★ 

★ 

★ 

★ 

★ 

★ 

★ 

★ 


*  Copyright  (c)  1988  BBN  Systems  and  Technologies,  Inc. 

*  All  rights  reserved. 


#include  "stdio.h" 

# include  "math.h" 

# include  "sim_types .h" 

# include  “sim_dfns.h” 

#include  ••mass_stdc  .h" 
#include  ■dgi_stdg.h“ 

^include  * s iin_c ig_i f  . h " 
#include  “protocol /pro_hdr .h" 
# include  " protocol /ammo .h" 
#include  " libnatrix.h" 
iinclude  "libmath.h" 

# include  “ librva_util .h" 
Iinclude  “libnear.h" 

Iinclude  "miss_nlos .h" 

Iinclude  “ libmiss_dfn .h” 
Iinclude  " libmiss_loc .h" 

/* 

*  Debug  macro 
*/ 

lifdef  FILEDBG 
Idefine  P{a)  a 

lelse 

Idefine  P{a) 
lendif 


/*/ 

*  Define  missile  characteristics. 
/*/ 

Idefine  NLOS_LOCK_THRESHOLD 
Idefine  NLOS_MAX_TURN_ANGLE 
Idefine  NLOS_VERTICAL_FLIGHT_TIME 
Idefine  NLOS_DECLINE_FLIGHT_TIME 


idefine  NLOS_LEVEL_FLIGHT__TIME 
Idefine  NLOS_ARM_TIME 
Idefine  NLOS_BURNOUT_TIME 
Idefine  NLOS_MAX_FLIGHT_TIME 
Idefine  SPEED_0 


nlos_miss_char  [  0] 
nlos_miss_char  [  1] 
nlDS_miss_char [  2] 
n]DS_miss_char  [  3] 

nlos_miss_char [  4] 
nlos_miss_char  [  5] 
nlos_miss_char  [  6] 

nlDS_miss_char  [  7] 
n3o£:_iniss_char  [  8] 
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#define  SPEED_1 
/*#define  THETA_0 
#define  THETA_0 


nlos_miss_char [  9] 

0.046542113  */  7*0.013962634*/ 

nlos_miss_char [ 10 ] 


' *  Set  parameters  which  will  control  flight  trajectory  behavior. 
/*/ 


#define  SIN_UNGUIDE 
Sdefine  COS_UNGUIDE 
# define  SIN_CLIMB 
ttdefine  COS_CLIMB 
# define  SIN_LOCK 
#define  COS_LOCK 
# define  C0S_TERM 
#define  COS_LOSE 


nlos_miss_char [11] 
nlos_miss_char [ 12 ] 
nlos_miss_char [ 13 ] 
nlos_miss_char [14] 
nlos_miss_char [ 15 ] 
nlos_miss_char [ 16 ] 
nlos_miss_char [ 17 ] 
nlos_miss_char [ 18 ] 


^*^  The  following  terms  set  the  order  of  the  polynomials  used  to  determine 

*  the  speed  or  cosine  of  the  maximum  allowed  turn  rate  of  the  missile 

*  at  any  point  in  time. 

/*/ 


#define  NLOS_BURN_SPEED_DEG  nlos_miss_poly_deg [ 0 ] 

#define  NLOS_COAST_SPEED_DEG  nlos_miss_poly_deg[l] 

/  ★/ 

*  NLOS  missile  characteristic  parameters  initialized  to  default  values 
/*/ 

static  REAL  nlos_miss_char [20]  = 

0  953153895,  /*  NLOS_LOCK_THRESHOLD  */ 

0  03490659,  /*  NLOS_MAX_TURN_ANGLE  radians/tick  / 


48.0, 

/* 

NLOS_VERTICAL_FLIGHT_TIME  */ 

105.0, 

/* 

NLOS_DECLINE_FLIGHT_TIME  */ 

140.0, 

/* 

NLOS_LEVEL_FLIGHT_TIME 

*/ 

20.0, 

/* 

NLOS_ARM_TIME 

ticks  {1.3  sec) 

22.5, 

/* 

NLOS_BURNOUT_T IME 

ticks  {1.5  sec) 

8000.0, 

11.33333333, 

/* 

NLOS_MAX_FLIGHT_TIME 

7*  SPEED_0  */ 

ticks  {120  sec) 

5.333333333, 

/* 

SPEED_1  */ 

.013962634*7 

/*  THETA_0 

0 

.046542113  */  /*0 

0.013962634, 

/* 

THETA_0  */ 

4  deg  */ 

0.069756474, 

/* 

SIN_UNGUIDE 

0.997564050, 

/* 

COS_UNGUIDE 

4  deg  */ 

0.004072424, 

/* 

SIN_CLIMB 

3.5  deg/sec  *7 

0.999991708, 

/* 

COS_CLIMB 

3.5  deg/sec  *7 

0.156434465, 

/* 

SIN_LOCK 

9  deg  */ 

0.987688341, 

/* 

COS_LOCK 

9  deg  *7 

0.984807753, 

/* 

COS_TERM 

0  deg  */ 

0.939692621, 

0.0 

/* 

COS_LOSE 

20  deg  */ 

}; 


/*/ 


-H 
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*  The  following  terms  set  the  order  of  the  polynomials  used  to  determine 

*  the  speed  and  turn  of  the  missile  at  any  point  in  time. 

/*/ 

static  int  nlos_miss_poly_deg [5]  - 

^  /*  Speed  before  motor  burnout.  */ 

3 1  /*  Speed  after  motor  burnout.  */ 

o! 

0, 

0 


1*1 

*  Coefficients  for  the  speed  polynomial  before  motor  burnout. 
/*/ 


static  REAL  nlos_burn 

{ 

0.03333333, 

1.25777777, 

0.0, 

'  0.0, 

0.0 

); 


.speed_coef  f  [5]  = 

/*  a_0  -  m/tick 
/*  a_l  -  m/tick** 


(  67.0  m/sec) 
{274.9732662  m/sec**2) 


*/ 

*/ 


/*/ 

*  Coefficients  for  the  speed  polynomial  after  motor  burnout. 
/*/ 


static  REAL  nlos_coast_speed_coef f [5]  = 


{ 


30.46972849, 

/* 

a_.0 

-9.7721160e-2, 

/* 

a_l 

1.2433925e-4, 

/* 

a_2 

-5.4061501e-8, 

/* 

a_3 

0.0 

}; 


-  m/tick 

(327.2858074 

m/sec) 

*/ 

-  m/tick**2 

(-21.4609544 

m/sec**2 ) 

*/ 

-  m/tick**3 

{  0.8227650 

m/sec**3 ) 

*/ 

-  m/tick**4 

{  -0.0133200 

m/sec**4 ) 

*/ 

static  VECTOR  nlos_initial_pos ; 
static  VECTOR  nlos_f inal_pos ; 
static  VECTOR  peak_target ; 
static  VECTOR  decline_target ; 
static  VECTOR  level_target ; 
static  int  nlos_target_id; 
static  int  nlos_req_id; 

/*/ 

*  Declare  static  functions. 

/*/ 

static  void  missile_nlos_stop  (); 


★ 
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*  ROUTINE:  missile_nlos_init 

*  PARAMETERS:  mptr  -  a  pointer  to  the  NLOS  to  be  ^ 

*  initialized.  * 

*  RETURNS:  none  .  ^ 

*  PURPOSE:  This  routine  initializes  the  state  or  the 

*  missile  to  indicate  that  it  is  available  and 

*  sets  values  that  never  change. 


*/ 


void  missile_nlos_init  (mptr) 
MISSILE  *mptr; 

{ 

int  i; 

int  data_tmp_int; 
float  data_tmp; 
char  descript [ 80 ] ; 
FILE  *fp; 


/* 


P(printf ("$$$$  NLOS  missile  file  data  $$$$\n");); 


DEFAULT  CHARACTERISTICS  DATA  FOR  miss_nlos.c  READ  FROM  FILE 

fp  =  f open { “ /s imnet /data/ms_nl_ch . d’  ,  r  ) ; 


if {fp==NULL) { 

fprintf (stderr, 
exit  ( )  ; 


“Cannot  open  /simnet/data/ms_nl_ch.d\n  ) ; 


} 


rewind (fp) ; 

/*  Read  array  data  */ 
i=0; 

while(fscanf{fp,"%f",  &data_tmp)  !=  EOF) { 

nlos_miss_char [ i ]  =  data_tmp; 
fgets (descript,  80,  fp); 

P (printf { "nlos_miss_char (%3d)  is%11.3f  %s“,  i, 

nlos_miss_char [ i ] ,  descript) ; ) ; 

++i; 

} 


*/ 


fclose(fp),  vTT  v 

/*  END  DEFAULT  CHARACTERISTICS  DATA  FOR  miss_nlos.c  READ  FROM  t iut, 

/*  DEFAULT  BURN  SPEED  DATA  FOR  miss_nlos.c  READ  FROM  FILE  */ 

fp  =  fopen ( " /simnet/data/ms_nl_bs .d“ , "r" ) ; 

if (fp==NULL) {  ,  ^ 

fprintf (stderr,  "Cannot  open  /simnet/data/ms_nl_bs .a\n  ), 

exit ( ) ; 

} 


rewind ( fp) ; 

/*  Read  degree  of  polynomial  */ 
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fscanf (fp, "%d",  &data_tmp_int) ; 

NLOS_BURN_SPEED_DEG  =  data_tmp_int ; 

is%3d  %s-,  NLOS_BURN_SPEED_DEG. 

descript) ; ) ; 

/*  Read  array  data  */ 
i  =  0; 

while{fscanf {fp, "%f",  &data_tmp)  I=EOF){ 
nlos_burn_speed_cbef f [ i ]  =  data_tmp; 

faets ( descript ,  80,  fp) ; 

pSntf('-nlL_burn_speed_coeff(%3d)  is%11.3f  %s",  i, 
nlos_burn_speed_coef f [ i] ,  descript) ; ) ; 

++  i ; 

} 

ENd'^dSuS^Wn  SPEED  DATA  FOR  miss_nlos.c  READ  FROM  FILE  */ 
DEFAULT  COAST  SPEED  DATA  FOR  miss_nlos.c  READ  FROM  FILE  */ 

fp  =  fopen ( " /simnet/data/ms_nl_cs .d“ , “r ” ) ; 

fprintf  {stderr,  "Cannot  open  /simnet/data/ins_nl_cs  .d\n'' )  ; 
exit ( ) ; 

) 

rewind (fp) ; 


Read  degree  of  polynomial  */ 


fscanf (fp, "%d" ,  &data_tmp_int)  ; 

NLOS_COAST_SPEED_DEG  =  data_tmp_int ; 

Pl^rintn-nloslmis^JolLdepd)  id»3d  %s-,  NLOS.COAST.SPEED.DEG, 
descript) ; ) ; 

/*  Read  array  data  */ 
i  =  0; 

while(fscanf (fp, "%f",  &data_tmp)  !=  EOF) { 

nlos_coast_speed_coef f [ i]  =  data_tmp; 
fgets (descript,  80,  fp) ;  „ 

P(printf {"nlos_coast_speed_coeff (%3d)  is%11.3f  %s  ,  i, 

nlos_coast_speed_coef f [i] ,  descript) ; ) ; 

++i; 


END^DeKuS' COAST  SPEED  DATA  FOR  miss_nlos.c  READ  FROM  FILE  */ 
ptr->state  =  FALSE; 

mptr->max_f  light_time  =  NLOS_MAX_FLIGHT_TIME; 
tnptr->max_turn_directions  =1; 
mptr->speed  =  SPEED_0 ; 
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inptr->cos_max_turn[0]  =  cos  (NLOS_MAX_TURN_ANGLE) ; 
nlos_req_id  =  NEAR_NO_REQUEST_PENDING; 
nlos_target_id  =  vehiclelDIrrelevant; 


/ 


*  ROUTINE:  missile_nlos_f ire  * 

*  PARAMETERS:  mptr  -  A  pointer  to  the  NLOS  missile  that  * 

*  is  to  be  launched.  * 

*  launch_point  -  The  location  in  world  * 

*  coordinates  that  the  missile  is  * 

*  launched  from.  * 

launch_to_world  -  The  transformation  matrix  of  * 

the  launch  platform  to  the  * 
world.  * 

launch_speed  -  The  speed  of  the  launch  * 

platform  (assumed  to  be  in  the  * 
direction  of  the  missile) .  * 
tube  -  The  tube  the  missile  was  launched  from.  * 

*  RETURNS:  none  * 

*  PURPOSE:  This  routine  performs  the  functions  * 

*  specifically  related  to  the  firing  of  a  * 

*  Hellfire  missile.  * 

*  * 
****************************************************************/ 


void  missile_nlos_f ire  (mptr,  launch_point,  launch_to_world,  launch_speed, 
tube) 

MISSILE  *mptr; 

VECTOR  launch_point ; 

T_MATRIX  launch_to_world; 

REAL  launch_speed; 
int  tube; 

{ 

/*/ 

*  Set  the  initial  time,  location,  orientation,  and  speed  of  the  generic 

*  missile. 

1*1 

mptr->time  =  0.0; 
mptr->speed  =  SPEED_0 ; 

vec_copy  {launch_point,  mptr->location) ; 
vec_copy  (launch_point,  nlos_initial_pos) ; 
mat_copy  ( launch_to_world,  mptr->orientation) ; 
mptr->init_speed  =  launch_speed; 

/*/ 

*  Tell  the  rest  of  the  world  about  the  firing  of  the  missile.  If  this 

*  cannot  be  done,  return. 

1*1 

if  { !missile_util_comm_f ire_missile  (mptr,  MSL_TYPE_MISSILE, 

ammoHellf ire,  EFF_HELLFIRE, 
vehiclelDIrrelevant,  targetUnltnown, 
fuzePointDetonating,  tube)) 

return; 
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*  If  all  was  successful,  set  the  missile  state  to  TRUE  and  return. 
/*/ 

mptr->state  =  TRUE; 

peak_target [X]  =  0.0; 
peak_target [Y]  =  1000.0; 
peak_target [Z]  =  1000.0; 

vec_mat_mul  {peak_target ,  mptr->orientation,  peak_target) ; 
vec_add  (mptr->location,  peak_target,  peak_target) ; 
printf ( "peak_target :  x  =  %f,  y  =  %f,  z  =  %f\n", 
peak_target [X] , 
peak_target [Y] , 
peak_target [Z] ) ; 

decline_target [X]  =  0.0; 
decline_target [Y]  =  1800.0; 
decline_target [Z]  =  0.0; 

vec_mat_mul  {decline_target,  mptr->orientation,  decline_target) ; 
vec_add  (mptr->location,  decline_target,  decline_target) ; 
printf (" decline_target :  x  =  %f,  y  =  %f/  z  =  %f\n  , 

'  decline_target [X] , 

decline_target [Y] , 
decline_target [Z] ) ; 

level_target [X]  =  0.0; 
level_target [Y]  =  2000.0; 
level_target [Z]  =300.0; 

vec_mat_mul  { level_target,  mptr->orientation,  level_target) ; 
vec_add  {mptr->location,  level_target,  level_target); 
printf (" level_target :  x  =  %f,  y  =  %f/  2  =  %f\n”, 
level_target [X]  , 
level_target [Y]  , 
level_target [Z] ) ; 


return; 

} 


y******** 

★ 


★ 


*  ROUTINE:  missile_nlos_f ly  _  ^ 

*  PARAMETERS:  mptr  -  A  pointer  to  the  NLOS  missile  that  * 

*  is  to  be  flown  out.  * 

*  target_location  -  The  location  in  world  * 

*  coordinates  of  the  target .  * 


*  RETURNS:  none  _  ^ 

*  PURPOSE:  This  routine  performs  the  functions  * 

*  specifically  related  to  the  flying  a  NLOS  * 

*  missile.  * 


void  missile_nlos_f ly  {mptr,  nlos_target_loc,  target_scheme) 
MISSILE  *mptr; 

VECTOR  nlos_target_loc; 
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int  target_scheme ; 

^  register  REAL  time;  /*  The  current  time  after  launch  (ticks).  */ 

register  REAL  temp;  ^  ^  v,  ■  i 

VehicleAppearancePDU  *target;  /*  A  pointer  to  the  target  vehicles 

appearance  packet.  */ 


timed_printf  { “target_scheme  =  %d\nloc  %f  %f  %f\n’‘, 
target_scheme , 
nlos_target_loc [ 0 ] , 
nlos_target_loc [ 1 ] , 
nlos_target_loc [ 2 ] 

) ; 

*/ 

/  */ 

*  Set  and  _time_.  This  is  created  mostly  for  increased  readablity. 
/*/ 

time  =  mptr->time; 

if  (time  >  800.0) 

'  mptr->speed  =  SPEED_1; 


/*/ 

*  choose  the  correct  targettting  option  depending  on  flight  time 
/*/ 

if  (time  ==  NLOS_LEVEL_FLIGHT_TIME) 

printf ("extra_waypoint:  %f  %f  %f\n", 
mptr->location [ 0 ]  , 
mptr->location [ 1  ]  , 
mptr->location[2]  )  ; 

if  (time  <  NLOS_VERTICAL_FLIGHT_TIME) 

miss ile_nlos_f ly_to_point (mptr ,  peak_target) ; 
else  if  (time  <  NLOS_DECLINE_FLIGHT_TIME) 

missile_nlos_fly_to_point (mptr,  decline_target) ; 
else  if  (time  <  NLOS_LEVEL_FLIGHT_TIME) 

{ 

level_target [Z]  =  mptr->location [Z] ; 
missile_nlos_f ly_to_point (mptr,  level_target) ; 

} 

else 

{ 

switch  (target_scheme) 

{ 

case  NLOS_FLY_TO_POINT_IN_SPACE: 

missile_nlos_f ly_to_point (mptr,  nlos_target_loc) ; 
break; 

case  NLOS_FLY_TO_POINT_RELATIVE; 

missile_target_nlos (mptr,  nlos_target_loc) ; 
break; 

case  NLOS_FLY_TO_TARGET : 

target  =  near_get_preferred_veh_near_vector  ( 
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&nlos_target_id, 

RVA_ALL_VEH , 
mptr->location, 
mptr->orientation [ 1 ] , 

NL0S_L0CK_THRESH0LD, 

&nlos_req_id) ; 
if  (target  !=  NULL) 

{ 

timed_printf  { "miss_nlos  ;  target  loclced  on\n"); 
inissile_target_pursuit  (mptr,  target) ; 

) 

else 

{ 

inissile_target_unguided(mptr)  ; 

} 

brea)c  ; 
default : 

printf  { "missile_nlos_f  ly :  bad  target_sclieine\n" )  ; 
brealc; 

} 

'  } 

/*/ 

*  checlt  to  see  if  the  missile  is  “out  of  gas" 

/*/ 

if  (mptr->time  >  1500.0) 
mptr->target [Z]  =0.0; 

/*/ 

*  Try  to  actually  fly  the  missile.  If  this  fails  stop  the  missile  altogether 

*  and  return. 

/*/ 

if  ( !missile_util_f lyout  (mptr)) 

{ 

missile_nlos_stop  (mptr) ; 
if  {target_scheme  ==  NLOS_FLY_TO_TARGET ) 

{ 

nlos_target_id  =  vehiclelDIrrelevant; 
nlos_req_id  =  NEAR_NO_REQUEST_PENDING; 

) 

return; 

} 

else 

{ 

/*/ 

*  If  the  missile  successfully  flew,  chec)c  for  an  intersection  with  the 

*  ground  or  a  vehicle.  If  one  is  found,  blow  up  the  missile,  stop  its 

*  flyout  and  return. 

/*/ 

if  {missile_util_comm_check_intersection  (mptr,  MSL_TYPE_MISSILE) ) 

{ 

missile_util_comm_chec'k_detonate  (mptr,  MSL_TYPE_MISSILE) ; 
missile_nlos_stop  (mptr) ; 
return ; 
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} 

) 

/*/ 

*  If  the  missile  is  to  continue  to  fly,  return. 
/*/ 

return; 

} 


^ **************************************************  ************** 

★ 

*  ROUTINE:  missile_nlos_stop'  * 

*  PARAMETERS:  mptr  -  A  pointer  to  the  NLOS  missile  that  * 

*  is  to  be  stopped.  * 

*  RETURNS :  none  * 

*  PURPOSE:  This  routine  causes  all  concerned  to  forget  * 

*  about  the  missile.  It  should  be  called  when  * 

*  the  flyout  of  any  NLOS  missile  is  stopped  * 

*  (whether  or  not  it  has  exploded) .  Note  that  * 

*  this  routine  can  only  be  called  within  this  * 

*  module .  * 

*  * 

****************************************************************/ 


static  void  missile_nlos_stop  (mptr) 

MISSILE  *mptr; 

{ 

/*/ 

*  Tell  the  world  to  stop  worrying  about  this  missile  then  release  the 

*  memory  for  use  by  other  missiles. 

1*1 

printf ( " initial_pos  =  %f  %f  %f\n“, 
nlos_initial_pos [0] , 
nlos_initial_pos [1] , 
nlos_initial_pos [2]); 

printf (” final_position  =  %f  %f  %f\n", 
mptr->location[0] , 
mptr->location [ 1 ] , 
mptr->location [2 ] ) ; 

missile_util_comm_stop_missile  (mptr,  MSL_TYPE_MISSILE) ; 

mptr->state  =  FALSE; 

} 
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understanding  of  the  CSU. 
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/*  $Header:  /a3/adst-cm/RWA/AIRNET/simnet/vehicle/libsrc/libmissile/RCS/miss_sti 

nger.c,v  1.4  1993/01/28  23:22:08  cm-adst  Exp  $  */ 

*  $Log:  miss_stinger .c, V  S 

*  Revision  1.4  1993/01/28  23:22:08  cm-adst 

*  P.DesMeules  changes  for  spcr  31 

* 

*  Revision  1.1  1992/09/30  16:39:52  cm-adst 

*  Initial  Version 


char  RCS  ID[]  =  "SHeader:  /a3/adst-cm/RWA/AIRNET/simnet/vehicle/libsrc/li 
bmissile/RCS/miss_stinger.c,v  1.4  1993/01/28  23:22:08  cm-adst  Exp  $“; 


/****************************** 

★ 

*  Revisions: 

* 

*  Version 


Date 


Author 


Title 


SP/CR  Number 


★ 

★ 

★ 

* 

* 

★ 

★ 

★ 

★ 

★ 


1.2 

1.3 

1.4 

1.5 


10/23/92  R.  Branson  Data  File  Initiali¬ 
zation 

10/30/92  R.  Branson  Added  pathname  to  data 

directory 

11/25/92  R.  Branson  Changed  %i  to  %d 

01/12/93  P.J.Desmeules  Increased  the  size 

of  the  fgets  to  make 
sure  the  whole  line  is 
read . 


31 


★  ■ 

*  SP/CR  No.  Description  of  Modification 


★ 

★ 

★ 

★ 

★ 

★ 

★ 

★ 

★ 

★ 


Hard  coded  defines  changed  to  array  elements. 
Characteristics/parameter  data  array  added. 

Degree  Of  polynomial  data  array  added. 

Added  file  reads  for  stinger  characteristics/ 

parameters,  burn  speed  coefficients,  and  coast 
speed  coefficients. 

Added  " /simnet/data/ "  to  each  data  file  pathname. 


/  ★  ★ 
★ 


★ 


*  FILE:  miss_stinger .c 

*  AUTHOR:  Bryant  Col lard 

*  MAINTAINER:  Bryant  Collard 


★ 

★ 

★ 
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*  PURPOSE: 

* 

* 

*  HISTORY; 

★ 

★ 

★ 


This  file  contains  routines  which  fly  out  a 
missile  with  the  characteristics  of  a  STINGER 
missile . 

12/08/88  bryant:  Creation 

04/24/89  bryant:  Added  static  memory  allocation 
08/07/90  bryant:  NIU  librva  modifications. 


★ 

★ 

* 

★ 

*  ★ 


Copyright  (c)  1988  BBN  Systems  and  Technologies,  Inc. 
All  rights  reserved. 


★ 

* 

*/ 


#include  "stdio.h" 
# include  “math.h" 


*/ 


*/ 


#include  " libmissile .h" 
#include  “ libmiss_dfn .h“ 
# include  " libmiss_loc .h" 

/* 

*  Debug  macro 
*/ 

#ifdef  FILEDBG 
#define  P{a)  a 

Seise 

Sdefine  P(a) 

Sendif 


# include 
# include 
# include 
Sinclude 
# include 
sinclude 
Sinclude 
/*--  need 
Sinclude 
Sinclude 

/* - 

Sinclude 


"sim_types .h" 

”  sim_dfns .h" 

“basic .h" 

“mun_type .h" 

“ libmap .h“ 

" libmatrix .h" 

" libnear .h“ 
Range_Squared  info 
"libhull.h" 
“libkin.h" 

"miss_stinger .h“ 


/*/ 

*  Define  missile  characteristics. 
/*/ 


Sdefine  STINGER_BURNOUT_TIME 
Sdefine  STINGER_MAX_FLIGHT_TIME 
Sdefine  STINGER_LOCK_THRESHOLD 
Sdefine  SPEED_0 
Sdefine  THETA_0 
Sdefine  INVEST_DIST_SQ 
Sdefine  FUZE_DIST_SQ 


stinger_miss_char [  0] 
stinger_miss_char [  1] 
stinger_miss_char [  2] 
stinger_miss_char [  3] 
stinger_miss_char [  4] 
stinger_miss_char [  5] 
stinger_miss_char [  6] 
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*  Define  the  states  the  _STINGER_MISSILE_  can  be  in. 

/*/ 

#define  STINGER_FREE  0  /*  No  missile  assigned.  ^  ^  . 

#define  STINGER_READY  1  /*  Missile  assigned  to  ready  state.  / 

#define  STINGER_FLYING  2  /*  Missile  assigned  to  flying  state.  / 

*  The  following  terms  set  the  order  of  the  polynomials  used  to  determine 

*  the  speed  of  the  missile  at  any  point  in  time. 

/*/ 

static  int  stinger_miss_poly_deg[2]  = 

I ^  /*  burn  speed  poly  degree  */ 

3  /*  coast  speed  poly  degree  */ 

}; 

' *  Stinger  missile  characteristic  parameters  initialized  to  default  values. 
/*/ 

static  REAL  stinger_miss_char [ 15]  = 

{• 

19.125,  /*  ticks  (1.275  sec)  */ 

400.000,  /*  ticks  (26.667  sec)  */ 

0.953153895,  /*  cos  (12.5  deg)  **  2  */ 

53.33333333,  /*  m/tick  (800  m/sec)  */ 

0.0174,  /*  rad/tick  (15.0  deg/sec)  */ 

90000.0,  /*  (300  m)  **  2  */ 

400.0,  /*  (20  m)  **  2  */ 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0 

); 

^ *  Coefficients  for  the  speed  polynomial  before  motor  burnout  initialized  to 

*  default  values. 

/*/ 

static  REAL  stinger_burn_speed_coef f [STINGER_BURN_SPEED_DEG  +  1]  = 

^1.9^  /*  a_0  -  m/tick  */ 

2.689324619  /*  a_l  -  m/tick**2  */ 

}; 

*  Coefficients  for  the  speed  polynomial  after  motor  burnout  initialized  to 

*  default  values. 

/*/ 
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static  REAL  stinger_coast_speed_coef f [STINGER_COAST_SPEED_DEG  + 


56.73662833, 
-0.182369351, 
2 .3302001e-4, 
-1.0176282e-7 


/*  a_0  -  m/tick  */ 

/*  a_l  -  m/tick**2  */ 
/*  a_2  -  m/tick**3  */ 
/*  a_3  -  m/tick**4  */ 


}; 


1]  = 


/*/ 

*  Memory  for  the  missiles  is  declared  in  vehicle  specific  code.  During 

*  initialization,  a  pointer' is  assigned  to  this  memory  then  all  memory 

*  issues  are  dealt  with  in  this  module. 

/*/ 

static  STINGER_MISSILE  *stinger_array ;  /*  A  pointer  to  missile  memory.  */ 

static 'int  num_stingers;  /*  The  number  of  defined  missiles.  */ 

static  ObjectType  stinger_ammo_type  =  munition_US_Stinger ; 

static  REAL  ,  .  , 

■  max_range_limit,  /*  [  MISSILE_US_MAX_RANGE_LIMIT  ]  / 

max_range_squared,  /*  [  MISSILE_US_MAX_RANGE_LIMIT  2  ]  / 

»  speed_factor;  /*  [  MISSILE_US_SPEED_FACTOR  ]  / 

1*1 

*  Declare  static  functions. 

/*/ 

static  void  missile_stinger_f ly  {); 


^ ******************************************************  ********** 

* 

★ 

*  ROUTINE:  missile_stinger_init  *  ^ 

*  PARAMETERS:  missile_array  -  A  pointer  to  an  array  of  * 

*  STINGER  missiles  defined  in  * 

*  vehicle  specific  code.  * 

*  num_missiles  -  The  number  missiles  defined  in  * 

*  _missile_array_.  * 

*  RETURNS :  none  *  ^ 

*  PURPOSE:  This  routine  copies  the  parameters  into 

*  variables  static  to  this  module  and  initializes  * 


the  state  of  all  the  missiles.  It  also 
initializes  the  proximity  fuze. 


void  raissile_stinger_init  {missile_array,  num_missiles) 
STINGER_MISSILE  missile_array [ ] ; 
int  num_missiles ; 

{ 

int  i;  /*  A  counter.  */ 
int  j  ; 

int  data_tmp_int ; 
float  data_tmp; 
char  descript [80]; 
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FILE  *fp; 

P{printf { "$$$$$  STINGER  missile  file  data  $$$$\n");); 

/*  DEFAULT  CHARACTERISTIC  DATA  FOR  miss_stinger . c  READ  FROM  FILE  */ 
fp  =  fopen(''/simnet/data/ms_st_ch.d“,  "r")  ; 
if (fp==NULL) { 

fprintf {stderr,  "Cannot  open  /simnet/data/ms_st_ch.d\n" ) ; 
exit  { )  ; 

) 

rewind ( fp) ; 

/*  Read  array  data  */ 
j=0; 

while{fscanf {fp, "%f",  &data_tmp)  !=  EOF) { 
stinger_miss_char [ j ]  =  data_tmp; 
fgets (descript ,  80,  fp) ; 

P(printf ("stinger_miss_char(%3d)  is%11.3f  %s",  j, 
stinger_miss_char [ j ] , 

(  descript) ;) ; 

++j  ; 

} 

fclose(fp); 

/*  END  DEFAULT  CHARACTERISTIC  DATA  FOR  miss_stinger . c  READ  FROM  FILE  */ 

/*  DEFAULT  BURN  SPEED  DATA  FOR  miss_stinger . c  READ  FROM  FILE  */ 

fp  =  fopen(“/simnet/data/ms_st_bs.d","r’’); 
if (fp==NULL) { 

fprintf (stderr,  "Cannot  open  /simnet/data/ms_st_bs .d\n" ) ; 
exit ( ) ; 

} 

rewind { fp) ; 

/*  Read  degree  of  polynomial  */ 

fscanf (fp, "%d",  &data_tmp_int )  ; 
stinger_miss_poly_deg [ 0 ]  =  data_tmp_int ; 
fgets {descript,  80,  fp) ; 

P(printf ( "stinger_miss_poly_deg{0)  is%3d  %s", 
stinger_miss_poly_deg [ 0 ] ,  descript) ; ) ; 

/*  Read  array  data  */ 

j=0; 

while(fscanf  (fp,  "%f ",  Scdata_tmp)  !=EOF){ 

stinger_burn_speed_coef f [ j ]  =  data_tmp; 
fgets {descript,  80,  fp); 

P{printf { "stinger_burn_speed_coef f {%3d)  is%11.3f  %s",  j, 

stinger_burn_speed_coef f [ j ] , 
descript)  ; )  ; 

++j  ; 
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) 

f close { fp) ; 

/*  END  DEFAULT  BURN  SPEED  DATA  FOR  miss_stinger . c  READ  FROM  FILE  */ 

/*  DEFAULT  COAST  SPEED  DATA  FOR  miss_stinger . c  READ  FROM  FILE  */ 
fp  =  fopen ( “ /simnet/data/ms_st_cs .d" , "r" ) ; 
if (fp==NULL) { 

fprintf (stderr,  "Cannot  open  /simnet/data/ms_st_cs .d\n" ) ; 
exit ( ) ; 

}  . 

rewind ( fp) ; 

/*  Read  degree  of  polynomial  */ 

fscanf (fp, “%d",  &data_tmp_int) ; 
stinger_miss_poly_deg [ 1 ]  =  data_tmp_int ; 
fgets (descript,  80,  fp) ; 

P(printf ( "stinger_miss_poly_deg{l)  is%3d  %s", 
stinger_miss_poly_deg[l] ,  descript) ; ) ; 

t 

/*  Read  array  data  */ 

j=0; 

while  (fscanf  (fp,  “%f" ,  Scdata_tmp)  !=  EOF)  { 

stinger_coast_speed_coef f [ j ]  =  data_tmp; 
fgets (descript,  80,  fp) ; 

P(printf ( "stinger_coast_speed_coeff (%3d)  is%11.3f  %s",  j, 

stinger_coast_speed_coef f [ j ] , 
descript) ; ) ; 

++j  ; 

} 

f close ( fp) ; 

/*  END  DEFAULT  COAST  SPEED  DATA  FOR  miss_stinger . c  READ  FROM  FILE 

num_stingers  =  num_missiles; 
stinger_array  =  missile_array ; 
for  (i  =  0;  i  <  num_missiles;  i++) 

{ 

stinger_array [ i ] .mptr . state  =  STINGER_FREE; 

stinger_array [ i ] .mptr .max_f light_time  =  STINGER_MAX_FLIGHT_TIME; 
stinger_array [ i] .mptr .max_turn_directions  =  1; 

} 

speed_f actor  =  MISSILE_US_SPEED_FACTOR; 
max_range_limit  =  MISSILE_US_MAX_RANGE_LIMIT ; 
max_range_squared  =  max_range_limit  *  roax_range_limit ; 
stinger_ammo_type  =  munition_US_Stinger ; 

/*/ 

*  Initialize  the  proximity  fuze. 

/*/ 

missile_fuze_prox_init  ( ) ; 

} 
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void  missile_stinger_set_speed_factor (  scale_speed  ) 

REAL  scale_speed; 

{ 

speed_f actor  =  scale_speed; 

} 

void  missile_stinger_set_max_range_limit (  limit_range  ) 
REAL  limit_range; 

{ 

max_range_limit  =  limit_range; 

niax_range_squared  =  max_range_limit  *  max_range_limit ; 

} 

void  inissile_stinger_set_animo_type{  ammo  ) 

ObjectType  ammo; 

{ 

stinger_ammo_type  =  ammo; 

} 


/f* 

★ 


*  ROUTINE:  missile_stinger_ready 

*  PARAMETERS:  none  * 

*  RETURNS:  A  pointer  to  a  missile  that  is  currently  * 

*  available.  * 

*  PURPOSE:  This  routine  finds,  if  possible,  a  missile  that  * 

*  is  not  being  used,  puts  it  in  a  ready  state  and  * 

*  returns  a  pointer  to  it.  * 


STINGER_MISSILE  *missile_stinger_ready  () 

{ 

int  i;  /*  A  counter.  */ 


/*/ 

•k 

/*/ 

/*/ 

★ 

★ 

/*/ 


/*/ 


Try  to  find  a  free  missile. 

for  (i  =  0;  i  <  num_stingers;  i++) 

{ 

If  a  free  missile  is  found,  put  it  in  a  ready  state,  clear  the  target 
ID  and  return  a  pointer  to  it. 

if  {stinger_array [i] .mptr.state  ==  STINGER_FREE) 

{ 

stinger_array [ i ] .mptr . state  =  STINGER_READY; 

stinger_array [ i ] . target_vehicle_id .vehicle  =  vehicleirrelevant ; 
return  {&stinger_array ( i ] ) ; 

} 


If  no  free  missile  is  found,  return  a  NULL  pointer. 


/*/ 
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return  (NULL) ; 

} 


*  ROUTINE:  missile_stinger_pre_launch  *  ^ 

*  PARAMETERS:  sptr  -  A  pointer  to  the  missile  that  is  to  be 

*  serviced.  * 

*  launch_point  -  The  location  of  the  missile  in  * 

*  world  coordinates.  * 

*  launch_to_world  -  The  transformation  matrix  of  * 

*  the  missile  to  the  world.  * 

*  veh_list  -  Vehicle  list  ID. 

*  RETURNS:  none  * 

*  PURPOSE:  This  routine  is  called  after  a  missile  has  been  * 

*  readied  and  before  it  has  been  launched.  It  * 

*  determines  if  the  seeker  head  can  see  a  target  * 


and,  if  it  can  see  a  target,  stores  its 
position.  * 


void  missile_stinger_pre_launch  (sptr,  launch_point,  launch_to_world,  veh_li'st) 
STINGER_MISSILE  *sptr; 

VECTOR  launch_poinf; 

T_MATRIX  launch_to_world; 
int  veh_list; 

VehicleAppearanceVariant  *target;  /*  A  pointer  to  the  target  vehicles 

appearance  packet.  */ 

/*/ 

*  Try  to  find  a  target. 

/*/ 

target  =  near_get_pref erred_veh_near_vector  (& (sptr->target_vehicle_id) , 
veh_list,  launch_point,  launch_to_world [ 1 ] , 

STINGER_LOCK_THRESHOLD) ; 

/*/ 

*  If  a  target  is  found,  store  its  location. 

/*/ 

if  (target  !=  NULL) 

{ 

sptr->target_vehicle_id  =  target->vehicleID; 
missile_target_pursuit  (& (sptr->mptr ) ,  target->location) ; 

} 

else 

sptr->target_vehicle_id .vehicle  =  vehicleirrelevant ; 

} 


*  ROUTINE:  missile_stinger_f ire 

*  PARAMETERS:  sptr  -  A  pointer  to  the  STINGER  missile  that 

*  is  to  be  launched.  * 


* 
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RETURNS : 
PURPOSE : 


launch_point 


The  location  in  world 
coordinates  that  the  missile  is 

launched  from.  * 

launch_to_world  -  The  transformation  matrix  of 
the  launch  platform  to  the 
world.  * 

launch_speed  -  The  speed  of  the  launch 

platform  (assumed  to  be  in  the 
direction  of  the  missile) .  * 
tube  -  The  tube  the  missile  was  launched  from. 
TRUE  for  a  successful  launch  and  FALSE  for  an 
unsuccessful  launch. 

This  routine  performs  the  functions  * 

specifically  related  to  the  firing  of  a 

STINGER  missile.  * 

★ 


int  missile_stinger_fire  (sptr,  launch_point,  launch_to_world,  launch_speed 
tube) 

STINGER_MISSILE  *sptr; 

VECTOR  launch_point; 

T_MATRIX  launch_to_world; 

REAL  launch_speed; 
int  tube; 

int  i;  /*  Counter.  */ 

MISSILE  *mptr;  /*  Pointer  to  the  particular  generic  missile 

pointed  at  by  _sptr_.  */ 

*  Get  a  pointer  to  the  generic  elements  of  the  STINGER  missile.  This 

*  improves  code  readability. 

/*/ 

mptr  =  & (sptr->mptr) ; 

/*/ 

*  Set  the  initial  time,  location,  orientation  and  speed  of  the  generic 

*  missile. 

/*/ 

mptr->time  =0.0; 

vec_copy  (launch  point,  mptr->location) ; 
mat_copy  { launch_to_world,  mptr->orientation) ; 
mptr->speed  =  launch_speed  + 

( speed_f actor  * 

m i s  s i 1 e_u t i l_e va l_po ly  ( ST INGER_BURN_S  PEED_DEG , 

stinger_burn_speed_coef f ,  0.0) ) ; 

mptr->init_speed  =  launch_speed; 

/*/ 

*  Indicate  that  the  proximity  fuze  has  no  vehicles  it  is  tracking. 

/*/ 

sptr->pptr  =  NULL; 

*  Determine  range  equations  for  intercept  targeting. 

/*/ 

sptr->stinger_burn_range_coeff [0]  =  0.0; 

for  (i  =  1;  i  <=  STINGER_BURN_SPEED_DEG  +  1;  i++) ; 
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sptr->stinger_burn_range_coef f [i]  =  (1.0  /  ((REAL)  i)) 

stinger_burn_speed_coef f [ i  -  1]; 


/*/ 


/*/ 


cDtr->stinger  burn  range_coef f [1]  +-  launch_speed;  t  u  j 

Sssilfta?geLint;r=apC.£ind_poly  (STINGER.COAST_SPEED_DEG,  launch.spaed, 
stinger_coast_speed_coeff,  sptr->stinger_coast_range_coef f , 
sptr->st inger_coast_range_2_coef f ) ; 

Tell  the  rest  of  the  world  about  the  firing  of  the  missile_  If  this 
cannot  be  done,  release  the  missile  memory  and  return  FALSE. 

if  ( !missile_util_comm_f ire_missile  (mptr,  MSL_TYPE_MISSILE, 

map_get_ammo_entry_from_network_type  (stinger_ammo_type) , 

stinger_ammo_type,  stinger_ammo_type,  ,  .  , 

&(sptr->target_vehicle_id) ,  targetlsVehicle,  ob:ectIrrelevant, 

tube) ) 


{ 


mptr->state  =  STINGER_FREE; 
return  (FALSE) ; 


/'*/ 

* 

* 

/*/ 


} 

If  all  was  successful,  set  the  missile  state  to  STINGER_FLYING  and 
return  TRUE. 

mptr->state  =  STINGER_FLYING; 
return  (TRUE) ; 


*  ROUTINE:  missile_stinger_f Iy_missiles 

*  PARAMETERS:  veh_list  -  Vehicle  list  ID. 

*  RETURNS:  none 

*  PURPOSE:  This  routine  flies  out  all  missiles  in  a 

*  flying  state. 


void  missile_stinger_fly_missiles  (veh_list) 
int  veh_list; 

int  i;  /*  A  counter.  */ 

/*/ 

*  Fly  out  all  flying  missiles. 

/*/  .  •  ^ 
for  (i  =  0;  i  <  num_stingers;  i++) 

if  (stinger_array [i] .mptr.state  ==  STINGER_FLYING) 

missile_stinger_fly  {& (stinger_array [ i] ) ,  veh_list) ; 

} 

) 
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/ 


*  ROUTINE:  missile_stinger_fly  ^ 

*  PARAMETERS:  sptr  -  A  pointer  to  the  STINGER  missile  t 

*  is  to  be  flown  out.  * 

*  veh_list  -  Vehicle  list  ID. 

*  RETURNS:  none  ,  ^ 

*  PURPOSE:  This  routine  performs  the  functions 

*  specifically  related  to  the  flying  a  STINGER 

*  missile. 


static  void  missile_stinger_f ly  (sptr,  veh_list) 
STINGER_MISSILE  *sptr; 
int  veh_list; 

{ 

register  MISSILE  *mptr; 


REAL  time; 

VehicleAppearanceVariant 

*target ; 


/*  A  pointer  to  the  generic  aspects  of 
_sptr_.  */ 

/*  The  current  time  after  launch  (ticks) 


/*  A  pointer  to  the  targets  appearance 
packet.  */ 


/*/ 


Set  _mptr_  and  _time_.  These  values  are  created  mostly  for  increased 

*  readablity. 

/*/ 

mptr  =  & (sptr->mptr) ; 
time  =  mptr->time; 

Find  thd  current  mlsnlle  speed  and  the  cosine  of  the  mximum  allowed  turn 

*  angle.  The  equations  used  are  different  before  and  after  motor  burnout. 

/*/ 

if  (time  <  STINGER_BURNOUT_TIME) 

^  mptr->speed  =  missile_util_eval_poly  (STINGER_BURN_SPEED_DEG, 
stinger_burn_speed_coef f ,  time)  +  mptr->init_spee  , 

) 

else 

^  mptr->speed  =  raissile_util_eval_poly  (STINGER_COAST_SPEED_DEG, 
stinger_coast_speed_coef f ,  time)  +  mptr->init_speed; 

} 

/  *  / 

*  Note  that  this  is  a  temporary  method  of  finding  turn  angle. 


/*/ 


/*/ 


mptr->cos_max_turn[0]  =  cos  (sqrt  (mptr->speed  /  (SPEED_0  + 
mptr->init_speed) )  *  THETA_0); 


*  Try  to  find  a  target.  If  one  is  found,  fly  towards  it  in  the 
proper  trajectory,  otherwise,  fly  in  a  straight  line. 


/*/ 


target  =  near_get_preferred_veh_near_vector  (& (sptr->target_vehicle_id) , 
veh_list,  mptr->location,  mptr->orientation [ 1 ] , 

stinger_lock_t:--reshold)  ,- 
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if(  inax_range_limit  >  0  &&  ^ 

kinematics_range_squared  (veh_kinematics ,  mptr->location) 

max_range_squared  ) 
missile_target_ground{  mptr  ); 
else  if  {target  !=  NULL) 

sptr->target_vehicle_id  =  target->vehicleID; 
if  (time  <  STINGER_BURNOUT_TIME) 

missile  target_intercept_pre_burnout  (mptr,  target, 

sptr->stinger_burn_range_coef f ,  STINGER_BURNOUT_TIME, 
STINGER_BURN_SPEED_DEG  +  1, 
sptr->st inger_coast_range_coef f , 
sptr->stinger_coast_range_2_coef f , 
STINGER_COAST_SPEED_DEG  +  1 ) ; 

else 

missile_target_intercept  (mptr,  target, 
sptr->stinger_coast_range_coef f , 
sptr->stinger_coast_range_2_coef f , 

STINGER_COAST_SPEED_DEG  +  1); 


sptr->target_vehicle_id. vehicle  =  vehicleirrelevant ; 
missile_target_unguided  (mptr) ; 


Try  to  actually  fly  the  missile.  If  this  fails,  stop  the  missile 
altogether  and  return. 

if  ( !missile_util_flyout  (mptr)) 

{ 

missile_stinger_stop  (sptr); 
return; 

} 

else 

{ 

If  the  missile  successfully  flew,  process  the  proximity  fuze. 

■if  f '5Dtr->tarcjet  vehicle  id. vehicle  ==  vehicleirrelevant) 

SssilSuzbrox  (o^tr,  MSL_TYPE_MISSILE,  PROX_FUZE_ON_ALL_VEH, 

& { sptr->target_vehicle_id) ,  & {sptr->pptr) , 

veh_list,  INVEST_DIST_SQ,  FUZE_DIST_SQ) ; 

'^^°missile_£uze_prox  Inptr,  MSL_TVPE_MISSILE,  PROX_FUZE_ON_ONE_VEH , 

& {sptr->target_vehicle_id) ,  & {sptr->pptr) , 

veh_list,  INVEST_DIST_SQ,  FUZE_DIST_SQ) ; 

If  the  missile  has  intersected  of  self  detonated,  blow  it  up,  stop  its 
flyout  and  return. 

if  {missile_util_comm_check_detonate  (mptr,  MSL_TYPE_MISSILE) ) 

{ 

missile_stinger_stop  (sptr) ; 
return; 
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) 

} 

/*/ 

*  If  the  missile  is  to  continue  to  fly,  return. 
/*/ 

return; 

} 


•k 


*  ROUTINE:  missile_stinger_stop  . 

*  PARAMETERS:  sptr  -  A  pointer  to  the  STINGER  missile  that 

*  is  to  be  stopped.  * 

*  RETURNS:  none  *  ^ 

*  PURPOSE:  This  routine  causes  all  concerned  to  forget 

*  about  the  missile.  It  should  be  called  when  * 

*  the  flyout  of  any  STINGER  missile  is  stopped 

*  {whether  or  not  it  has  exploded) .  * 


void  missile_stinger_stop  (sptr) 

STINGER_MISSILE  *sptr; 

{ 

^ If  the  missile  has  been  fired,  tell  the  world  to  stop  it  and  clear  the 
*  proximity  fuze  targets.  Release  missile  memory  for  use  by  other  missiles. 


if  (sptr->mptr .state  ==  STINGER_FLYING) 

missile_util_comm_stop_missile  {& (sptr->mptr) ,  MSL_TYPE_MISSILE) ; 
missile_fuze_prox_stop  (& (sptr->pptr) ) ; 


) 

sptr->mptr . state  =  STINGER_FREE; 
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/*  $Header :  /a3 /adst -cm/RWA/AIRNET/simnet /vehicle/ libsrc/libmissile/RCS/iniss_tow 

.c,v  1.4  1993/01/28  23:22:08  cm-adst  Exp  $  */ 

/* 

*  $Log:  miss_tow.c,v  $ 

*  Revision  1.4  1993/01/28  23:22:08  cm-adst 

*  P.DesMeules  changes  for  spcr  31 

* 

*  Revision  1.3  1993/01/06  21:14:12  cm-adst 

*  R.Branson's  changes  for  the  weapons  model. 

* 

*  Revision  1.1  1992/09/30  16:39:52  cm-adst 

*  Initial  Version 

* 

*/ 

static  char  RCS_1D[]  =  "$Header:  /a3/adst-cm/RWA/AlRNET/simnet/vehicle/libsrc/li 
bmissile/RCS/miss_tow . c , V  1.4  1993/01/28  23:22:08  cm-adst  Exp  $"; 


/ 


*  Revisions: 

★ 


Version 

1.2 

1.3 

1.4 

1.5 


Date 


Author 


Title 


SP/CR  Number 


10/23/92  R.  Branson  Data  File  Initiali¬ 
zation 

10/30/92  R.  Branson  Added  pathname  to  data 

directory 

11/25/92  R.  Branson  Changed  %i  to  %d 


31 


01/19/93  P.Desmeules  Increased  the  size  of  the 

fgets  to  make  sure  the 
whole  line  is  read  in. 
*****************************************************************************/ 


★ 


★ 

* 

★ 

it 

it 

★ 

★ 

★ 


SP/CR  No. 


Description  of  Modification 


Hard  coded  defines  changed  to  array  elements. 

Characteristics/parameter  data  array  added. 

Degree  of  polynomial  data  array  added. 

Added  file  reads  for  TOW  characteristics/parameters, 
burn  speed  coefficients,  coast  speed  coefficients, 
burn  turn  coefficients,  and  coast  turn  coeffi- 
coef ficients . 


*  Added  " /simnet/data/ "  to  each  data  file  pathname. 

* 

* 

*  FILE:  miss_tow.c  * 
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*  AUTHOR: 

*  MAINTAINER: 

*  PURPOSE; 

* 

★ 

*  HISTORY: 

* 

* 


Bryant  Collard 
Bryant  Collard 

This  file  contains  routines  which  fly  out  a 
missile  with  the  characteristics  of  a  TOW 
missile . 

10/31/88  bryant:  Creation 
4/26/89  bryant:  Added  statically  allocated  mem 


★ 

*  Copyright  (c)  1988  BBN  Systoins  a.nd  Technologiss ,  Inc, 

*  All  rights  reserved. 

* 


* 

* 

★ 

★ 

★ 

★ 

★ 

★ 

* 

★ 

★ 

★ 


#include  "stdio.h" 

# include  "sim_types .h" 

# include  "sim_dfns .h" 

# include  "basic.h" 

#include  “mun_type .h“ 

# include  “libmatrix.h" 

# include  “libmap.h" 

/* —  need  Range_Squared  info 
iinclude  "libhull.h" 

# include  "libkin.h" 

/* - 

# include  "miss_tow.h'' 

#include  " libmissile .h" 

#include  " libmiss_dfn .h" 
ftinclude  " libmiss_loc .h" 

/* 

*  Debug  macro 
*/ 

Sifdef  FILEDBG 
#define  P(a)  a 

#else 

#define  P{a) 

#endif 

/*/ 

*  Define  missile  characteristics. 

/*/ 

#define  TOW_BURNOUT_TIME  tow_miss_char [ 0 ] 

Sdefine  TOW_RANGE_LIMIT_TIME  tow_miss_char [ 1 ] 

#define  TOW_MAX_FLIGHT_TIME  tow_miss_char [2 ] 

/*/  .  • 

*  The  following  terms  set  the  order  of  the  polynomials  used  to  determine 

*  the  speed  or  cosine  of  the  maximum  allowed  turn  rate  of  the  missile 

*  at  any  point  in  time. 

/*/ 


__*/ 

--*/ 
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itdefine  TOW_BURN_SPEED_DEG  tow_miss_poly_deg  [  0  ] 

#define  TOW_COAST_SPEED_DEG  tow_miss_poly_deg [ 1 ] 

#define  TOW_BURN_TURN_DEG  tow_tniss_poly_deg  [2  ] 

#define  TOW_COAST_TURN_DEG  tow_miss_poly_deg [ 3 ] 

/  ★  / 

*  Tow  missile  characteristic  parameters  initialized  to  default  values. 

/*/ 

static  REAL  tow_miss_char [5]  = 

24.0,  /*  ticks  (1.6  sec)  */ 

268.35,  /*  ticks  (17.89  sec)  */  .  . 

300.00,  /*  ticks  -  cos  of  max  turn  >  1.0  beyond  this  point  / 

0.0, 

0.0 

}; 

^ *  The  following  terms  set  the  order  of  the  polynomials  used  to  determine 

*  the  speed  and  turn  of  the  missile  at  any  point  in  time. 

/*/ 

s'tatic  int  tow_miss_poly_deg[5]  = 

2,  /*  Speed  before  motor  burnout.  */ 

3^  /*  Speed  after  motor  burnout.  */ 

/*  Cosine  of  max  turn  before  burnout.  */ 

3’  /*  Cosine  of  max  turn  after  burnout.  */ 

0  /*  not  used.  */ 

}; 

*  Coefficients  for  the  speed  polynomial  before  motor  burnout  initialized 

*  to  default  values. 

/*/ 

static  REAL  tow_burn_speed_coef f [5]  = 

4.466666667,  /*  a_0  -  m/tick  (67.0  m/sec)  */ 

1.222103405,  /*  a_l  -  in/tick**2  (274.9732662  m/sec  2)  / 

-0.024532086,  /*  a_2  -  m/tick**3  (-82.7057910  m/sec**3)  */ 

0.0, 

0.0 

}; 

/*/ 

*  Coefficients  for  the  speed  polynomial  after  motor  burnout. 

/*/ 

static  REAL  tow_coast_speed_coeff [5]  = 

21  81905383,  /*  a_0  -  m/tick  (327.2858074  m/sec)  */ 

-953820190-2,  /*  a_l  -  m/tick**2  (-21.4609544  m/sec**2)  */ 

2*43782220-4!  /*  a_2  -  m/tick**3  (0.8227650  m/sec**3)  */ 

-2 . 6311111e-7 ,  /*  a_3  -  m/tick**4  (-0.0133200  m/sec**4)  */ 

0.0 
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} ; 


/  */ 

*  Coefficients  for  the  cosine  of  max  turn  polynomials  before  motor  burnout 

*  The  structure  _MAX_COS_COEFF_  is  used  to  store  the  values  for  the  turn 

*  sideways,  up,  and  down  polynomials  along  with  their  order. 

/*/ 


static 

{ 

1, 

{ 


}, 

{ 


MAX_COS_COEFF  tow_burn_turn_coef f  = 


/*  Order  of  the  polynomials.  */ 


0.999976868652, 
-3 .5933955e-7 


/*  Sidewards  turn.  */ 

/*  a_0  -  cos (rad) /tick  */ 

/*  a_l  -  cos (rad) /tick**2  */ 


0.999960667258, 
-3 .1492328e-6 


/*  Upwards  turn.  */ 

/*  a_0  -  cos (rad) /tick  */ 

/*  a_l  -  cos (rad) /tick**2  */ 


0.999978909989, 
-7 .8194991e-9 


/*  Downwards  turn.  */ 

/*  a_0  -  cos (rad) /tick  */ 

/*  a_l  -  cos (rad) /tick* *2  */ 


/*/ 

*  Coefficients  for  the  cosine  of  max  turn  polynomials  after  motor  burnout 
/*/ 


static  MAX_COS_COEFF  tow_coast_turn_coef f  = 


3, 

{ 


), 

{ 


0.99995112518, 

8.96333e-7, 

-5 .995375e-9, 
1.162225e-ll 


0.9998498495, 

1.657779e-6, 

-8.231861e-9, 

1.381832e-ll 


}, 

{ 


0.9999714014, 
3 .382077e-7, 
-1.601259e-9, 

2 .623014e-12 


/*  Order  of  the  polynomials.  */ 

/*  Sidewards  turn.  */ 

/*  a_0  -  cos (rad) /tick  */ 

/*  a_l  -  cos (rad) /tick**2  */ 

/*  a_2  -  cos(rad) /tick**3  */ 

/*  a_3  -  cos (rad) /tick**4  */ 


/*  Upwards  turn.  */ 

/*  a_0  -  cos (rad) /tick  */ 

/*  a_l  -  cos (rad) /tick**2  */ 
/*  a_2  -  cos (rad) /tick**3  */ 
/*  a_3  -  cos (rad) /tick**4  */ 


/*  Downwards  turn.  */ 

/*  a_0  -  cos (rad) /tick  */ 

/*  a_l  -  cos (rad) /tick**2  */ 
/*  a_2  -  cos (rad) /tick**3  */ 
/*  a_3  -  cos (rad) /tick**4  */ 
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} 

}  ; 


*/ 

*/ 

*/ 


/*/ 

*  Declare  static  functions, 
static  void  inissile_tow_stop  (); 


static  ObjectType  tow_ammo_type  =  munition_US_TOW; 

^^^^mL!range_liinit,  /*  [  MISSILE_US_MAX_RANGE_LIMIT  ^ 

max  range_squared,  /*  [  MISSILE_US_MAX_RANGE_LIMIT 

speed_f actor ;  /*  [  MISSILE_US_SPEED_FACTOR  ] 


/ 


**************,************************************************* 

★ 

★ 

*  ROUTINE:  missile_tow_init  *  ^ 

*  PARAMETERS:  tptr  -  a  pointer  to  the  TOW  to  be  ^ 

*  initialized. 

*  RETURNS:  none  ....  ^  v,  * 

*  PURPOSE:  This  routine  initializes  the  state  of  the 

*  missile  to  indicate  that  it  is  available  and 

*  sets  values  that  never  change. 

★ 

★***************************************************************/ 


* 

★ 


void  missile_tow_init  (tptr) 

TOW_MISSILE  *tptr; 

{ 

int  i  ; 

int  data_tmp_int; 
float  data_tmp; 
char  descript [80] ; 

FILE  *fp; 

P(printf  {"$$$$  TOW  missile  file  data  $$$$\n'');); 

/*  DEFAULT  CHARACTERISTICS  DATA  FOR  miss_tow.c  READ  FROM  FILE  */ 

fp  =  f open { “ /s imnet /data/ms_tw_ch . d" , " r " ) ; 

if  {fp  =  =NULL)  {  _  ^  ^ 

fprintf (stderr ,  "Cannot  open  /simnet/data/ms_tw_cn.a\n 

exit { ) ; 

} 

rewind { fp) ; 

/*  Read  array  data  */ 
i  =  0; 

while{fscanf  {fp, &data_tmp)  !=  EOF)  { 
tow_miss_char [ i ]  =  data_tmp ; 

fgets (descript,  80,  fp) ;  .  .  r;i 

P (printf ( “tow_miss_char (%3d)  is%11.3f  %s“,  i,  tow_miss_char [  ], 

descript) ; ) ; 
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++i; 

} 

f close { fp) ; 

/*  END  DEFAULT  CHARACTERISTICS  DATA  FOR  miss_tow.c  READ  FROM  FILE  */ 

/*  DEFAULT  BURN  SPEED  DATA  FOR  miss_tow.c  READ  FROM  FILE  */ 

fp  =  fopen ( " /simnet/data/ms_tw_bs .d" , "r" ) ; 
if {fp==NULL) { 

fprintf  (stderr,  "Cannot  open  /simnet/data/ms_tw_bs  .d\n'' )  ; 
exitO; 

} 

rewind { fp) ; 

/*  Read  degree  of  polynomial  */ 

fscanf (fp, "%d",  &data_tmp_int) ; 

TOW_BURN_SPEED_DEG  =  data_tmp_int ; 
fgets {descript,  80,  fp); 

P (printf ( “ tow_miss_polY_deg ( 0 )  is%3d  %s",  TOW_BURN_SPEED_DEG, 

»  descript);); 

/*  Read  array  data  */ 

i  =  0; 

while  ( fscanf  { fp,  "  %f " ,  Scdata_tinp)  !=  EOF)  { 
tow_burn_speed_coef f [ i ]  =  data_tmp; 
fgets (descript,  80,  fp); 

P (printf ( "tow_burn_speed_coef f {%3d)  is%11.3f  %s",  i, 
tow_burn_speed_coef f [i] ,  descript) ; ) ; 

++i; 

} 

f close ( fp) ; 

/*  END  DEFAULT  BURN  SPEED  DATA  FOR  miss_tow.c  READ  FROM  FILE  */ 

/*  DEFAULT  COAST  SPEED  DATA  FOR  miss_tow.c  READ  FROM  FILE  */ 

fp  =  fopen("/simnet/data/ms_tw_cs.d",”r"); 
if (fp==NULL) { 

fprintf (stderr,  "Cannot  open  /simnet/data/ms_tw_cs .d\n" ) ; 
exit { ) ; 

) 

rewind { fp) ; 

/*  Read  degree  of  polynomial  */ 

fscanf (fp, "%d",  &data_tmp_int) ; 

TOW_COAST_SPEED_DEG  =  data_tmp_int ; 
fgets (descript,  80,  fp) ; 

P(printf  ( ''tow_miss_poly_deg{l)  is%3d  %s",  TOW_COAST_SPEED_DEG, 
descript) ; ) ; 

/*  Read  array  data  */ 
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whileCfscanf  (fp, &data_tmp)  !=EOF){ 
tow_coast_speed_coeff  [i]  =  data_tnip; 
fgets (descript,  80,  fp); 

P{printf  ( “tow_coast_speed_coeff  (%3d)  is%11.3f  %s'', 

tow_coast_speed_coef f [ i ] ,  descript) ; ) ; 

++i; 


/* 

/* 


f close ( fp) ; 

END  DEFAULT  COAST  SPEED  DATA  FOR  miss_tow.c  READ  FROM  FILE 


DEFAULT  BURN  TURN  DATA  FOR  miss_tow.c  READ  FROM  FILE 

fp  =  f open  { "  / s imnet /data/rns_tw_bt .  d“ ,  "  r " )  ; 


*/ 

*/ 


if (fp==NULL) ( 

fprintf (stderr, 
exit  { )  ; 


"Cannot  open  /siinnet/data/ms_tw_bt  .d\n  )  ; 


} 


rewind ( fp) ; 

/*  Read  degree  of  polynomial  */ 


fscanf (fp, "%d",  &data_tmp_int) ; 

TOW_BURN_TURN_DEG  =  data_tmp_int; 
tow_burn_turn_coef f .deg  =  data_tmp_int; 
fgets  {descript,  80,  fp)  ; 

P (printf ( " tow_miss_poly_deg (2)  is%3d  %s",  TOW_BURN_TURN_DEG , 
descript) ; ) ; 


/*  Read  array  data  */ 

for  {i=0;  i  <=  data_tmp_int ;  i++)  { 

fscanf  (fp,  "%f'' ,  &data_tmp); 

tow_burn_turn_coef f . side_coef f [ i ]  =  data_tmp; 

fgets  (descript,  80,  fp)  ;  •  0.11  op  9. 

P  (printf  { ''tow_burn_turn_coef  f .  side_coeff  {%3d)  is%11.3r  «s  , 

tow_burn_turn_coef f . s ide_coef f [ i ]  ,  descript) ; ) , 

) 

for  {i=0;  i  <=  data_tmp_int ;  i++)  { 

fscanf  (fp, ''%f'' ,  &data_tmp); 

tow_burn_turn_coef  f  .up_coef  f  [ i ]  =  data_tnip; 

fgets  {descript,  80,  fp)  ;  •Q.iiopa--' 

P{printf ( “tow_burn_turn_coeff .up_coef f (%3d)  is%11.3f  %s  ,  1 

tow_burn_turn_coef f . up_coef f [ i ]  ,  descript) ; ) , 

} 

for  (i=0;  i  <=  data_tmp_int;  i++)  { 

fscanf (fp, "%f“ ,  &data_tmp) ; 

tow_burn_turn_coef f .down_coef f [ i ]  =  data_tmp; 

fgets  (descript,  80,  fp)  ;  2.  „ 

P (printf ( "tow_burn_turn_coef f .down_coeff {%3d)  is%11.3f  %s  , 

tow_burn_turn_coef f . down_coef f [ i ]  ,  descript) ; ) ; 
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) 


/*  END  DEFAULT^ BURN  TURN  DATA  FOR  miss_tow.c  READ  FROM  FILE 


*/ 

*/ 


/*  DEFAULT  COAST  TURN  DATA  FOR  miss_tow.c  READ  FROM  FILE 

fp  =  fopen  ( " /siinnet/data/ms_tw_ct  .d  ,  r  )  ; 

if  {fp==NULL)  (  .  _  ,  ^  ^ 

fprintf (stderr,  “Cannot  open  /siinnet/data/ms_tw_cc .a\n  ), 

exit { ) ; 

} 


t 


rewind ( fp) ; 

/*  Read  degree  of  polynomial  */ 


f scanf { f p , “ %d “ ,  &data_tmp_int ) ; 
TOW_COAST_TURN_DEG  =  data_tmp_int; 
tow_coast_turn_coef f .deg  =  data_tmp_int; 
fgets {descript ,  80,  fp) ; 

P(printf ( “tow_miss_poly_deg(3)  is%3d  %s“, 
descript) ; ) ; 


TOW_COAST_TURN_DEG , 


Read  array  data 


for 


(i=0;  i  <=  data_tmp_int;  i++)  { 

fscanf (fp, "%f ",  &data_tmp); 

tow_coast_turn_coef f .side_coef f [ i]  =  data_tmp; 

fgets  (descript,  80,  fp)  ;  _  •  ■sf  a-  » 

P(printf ( “tow_coast_turn_coef f .side_coef f {%3d)  is%11.3r  %s  , 

tow_coast_turn_coef f . side_coef f [ i] ,  descript) ; ) ; 


i, 


for  (i=0;  i  <=  data_tmp_int;  i++)  { 
fscanf (fp, "%f",  &data_tmp) ; 

tow_coast_turn_coef f .up_coef f ( i ]  =  data_tmp; 

fgets  (descript,  80,  fp)  ;  _ 

P (printf ( " tow_coast_turn_coef f .up_coef f (%3d)  is%11.3t  %s  ,  i 

tow_coast_turn_coef f .up_coef f [ i ] ,  descript) ; ) ; 

} 


for 


} 


(i=0;  i  <=  data_tmp_int;  i++)  ( 

fscanf  (fp,  &data_tmp); 

tow_coast_turn_coeff .down_coeff [i]  =  data_tmp; 

fgets {descript,  80,  fp) ; 

P (printf ( "tow_coast_turn_coef f .down_coef f (%3d) 
tow_coast_turn_coef f .down_coeff [i] 


is%11.3f  %s",  i, 
descript) ; ) ; 


/* 


fclose { fp) ; 

END  DEFAULT  COAST 


TURN  DATA  FOR  miss_tow.c  READ  FROM  FILE 


tptr->mptr . state  =  FALSE; 

tptr->mptr .max_flight_time  =  TOW_MAX_FLIGHT_TIME; 
tptr->mptr .max_turn_directions  =  3; 


*/ 
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speed_f actor  =  MISSILE_US_SPEED_FACTOR; 
max_range_limit  =  MISSILE_US_MAX_RANGE_LIMIT; 
max_range_squared  =  max_range_liinit  *  max_range_limit , 
tow_ammo_type  =  munition_US_TOW; 


void  missile_tow_set_speed_f actor {  scale_speed  ) 

REAL  scale_speed; 

{ 

speed_f actor  =  scale_speed; 

} 

void  missile_tow_set_max_range_limit (  limit_range  ) 

REAL  liinit_range; 

{ 

max_range_limit  =  limit_range; 

max_range_squared  =  rnax_range_liinit  *  max_range_limit ; 

} 


void  missile_tow_set_ammo_type {  ammo  ) 
oijectType  ammo; 


{ 


} 


tow_ammo_type  =  ammo; 


/**************************************************************** 
*  * 

*  ROUTINE:  missile_tow_f ire  _* 

*  PARAMETERS:  tptr  -  A  pointer  to  the  TOW  missile  to  be  * 


*  PARAMETERS: 


fired . 

launch_point  -  The  location  in  world  * 

*  coordinates  that  the  missile  is  * 

*  launched  from.  * 

*  loc_sight_to_world  -  The  sight  to  world  * 

*  transformation  matrix  used  * 

*  only  in  this  routine.  * 

*  launch_speed  -  The  speed  of  the  launch  * 

*  platform  (assumed  to  be  in  the  * 

*  direction  of  the  missile) .  * 

*  tube  -  The  tube  the  missile  was  launched  from.  * 

*  RETURNS:  none  * 

*  PURPOSE:  This  routine  performs  the  functions  * 

*  specifically  related  to  the  firing  of  a  TOW  * 

*  missile.  * 

*  * 
****************************************************************/ 


TOW_MISSILE  *missile_tow_f ire  (tptr,  launch_point ,  loc_sight_to_world, 
launch_speed,  tube) 

TOW_MISSILE  *tptr; 

VECTOR  launch_point ; 

T_MATRIX  loc_sight_to_world; 

REAL  launch_speed; 
int  tube; 
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MISSILE  *mptr;  /*  Pointer  to  the  particular  generic  missile 

pointed  at  by  _tptr_.  */ 

/*/ 

*  Find  _mptr_. 

/*/ 

mptr  =  &(tptr->mptr) ; 

/*/ 

*  Set  the  initial  time,  location,  orientation,  and  speed  of  the  generic 

*  missile. 

/*/ 

mptr->time  =0.0; 

vec _ copy  (launch _ point,  mptr“>location) , 

jfiat_copy  (loc_sight _ to_world,  mptr— >orientation)  ; 

mntr->speed  =  launch_speed  + 

(speed.factor  *  missile_util_eval_poly  (TOW_BURN_SPEED_DEG, 

tow_burn_speed_coef  f ,  0.0)) 

mptr->init_speed  =  launch_speed; 

/*/ 

*  Set  the  wire  as  uncut. 

/*/ 

'  tptr->wire_is_cut  =  FALSE; 

*  Tell  the  rest  of  the  world  about  the  firing  of  the  missile.  If  this 

*  cannot  be  done,  return. 

/*/ 

if  { imissile_util_comm_f ire_missile  (mptr,  MSL_TYPE_MISSILE, 
map_get_ammo_entry_from_network_type  (tow_ammo_type) , 

tow_ammo_type,  tow_ammo_type,  NULL,  targetUnknown, 
objectirrelevant,  tube)) 
return ; 

*  If  all  was  successful,  set  the  missile  state  to  TRUE  and  return. 

/*/ 

mptr->state  =  TRUE; 
return; 


/**************************************************************** 

'  ★ 

* 

*  ROUTINE:  missile_tow_f ly  __  . 

*  ’PARAMETERS:  tptr  -  A  pointer  to  the  TOW  missile  that  is  to 

*  be  flown  out. 

*  sight_location  -  The  location  in  world  * 

*  coordinates  of  the  gunner's  * 

*  sight.  * 

*  loc_sight_to_world  -  The  sight  to  world 

*  transformation  matrix  used  * 

*  only  in  this  routine.  * 

*  RETURNS:  none 

*  PURPOSE:  This  routine  performs  the  functions 


specifically  related  to  the  flying  a  TOW 
missile . 


★ 

★  _ _ 

★ 

★ 
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void  missile_tow_fly  (tptr,  sight_location,  loc_sight_to_world) 

TOW_MISSILE  *tptr; 

VECTOR  sight_location; 

T_MATRIX  loc_sight_to_world; 

MISSILE  *mptr;  /*  A  pointer  to  the  generic  aspects  of  _tptr_.  */ 

REAL  time;  /*  The  current  time  after  launch  (ticks) .  */ 

/*/ 

*  Set  _mptr_  and  _time_.  These  values  are  created  mostly  for  increased 

*  readablity. 

/*/ 

mptr  =  & (tptr->mptr) ; 
time  =  mptr->time; 

1*1  .  ■ 

*  jf  the  missile  has  reached  its  maximum  range  (not  the  maximum  distance 

*  its  allowed  to  fly),  cut  the  wire. 

/*/ 

#ifdef  notdeff 

if  {(time  >  TOW_RANGE_LIMIT_TIME)  &&  ! tptr->wire_is_cut ) 
tptr->wire_is_cut  =  TRUE; 

rfendif 

if  ( ! tptr->wire_is_cut  && 

((time  >  TOW_RANGE_LIMIT_TIME)  M 
{max_range_limit  >  0  &&  ^  i  \ 

kinematics_range_squared  (veh_kinematics ,  mptr->location)  > 
max_range_squared)  ) ) 
tptr->wire_is_cut  =  TRUE; 

/*/ 

*  Find  the  current  missile  speed  and  the  cosines  of  the  maximum  allowed  turn 

*  angles  in  each  direction.  The  equations  used  are  different  before  and 

*  after  motor  burnout. 


/*/ 

if  (time  <  TOW_BURNOUT_TIME) 

{ 

raptr->speed  =  mptr->init_speed  + 

(speed_f actor  * 

missile_util_eval_poly  {TOW_BURN_SPEED_DEG, 

tow_burn_speed_coef f ,  time)); 

missile_util_eval_cos_coef f  (mptr,  &tow_burn_turn_coef f ,  time 

} 

else 


{ 

mptr->speed  =  mptr->init_speed  + 

(speed_f actor  * 

missile_util_eval_poly  (TOW_COAST_SPEED_DEG, 

tow_coast_speed_coef f ,  time) ) ; 

missile_util_eval_cos_coef f  (mptr,  &tow_coast_turn_coef f ,  time) 


} 

/*/ 

*  If  the  wire  has  been  cut,  set  the  ground  as  the  target;  otherwise, 

*  find  a  target  point  which  will  fly  the  missile  along  the  gunner  s  me  o 

*  sight.  This  targeting  scheme  takes  into  account  the  errors  introduced  by 

*  attempting  to  guide  the  missile  in  a  canted  position. 

/*/ 
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if  {tptr->wire_is_cut ) 

inissile_target_ground  (mptr)  ; 

^^^\issile_target_level_los  (mptr,  sight_location,  loc_sight_to_world) ; 

Try  to  actually  fly  the  missile.  If  this  fails  stop  the  missile  altogether 
and  return. 

if  ( !missile_util_f lyout  (mptr)) 

( 

missile_tow_stop  (tptr); 
return; 

} 

else 

{ 

If  the  missile  successfully  flew,  check  for  an  intersection  with  the 
ground  or  a  vehicle.  If  one  is  found,  blow  up  the  missile,  stop  its 
flyout  and  return. 

if  {inissile_util_comm_check_intersection  (mptr,  MSL_TYPE_MISSILE) ) 

missile_util_comm_check_detonate  (mptr,  MSL_TYPE_MISSILE) , 

missile_tow_stop  (tptr) ; 

return; 


If  the  missile  is  to  continue  to  fly,  return. 


return; 


/**************************************************************** 

'  ★ 

it 

*  ROUTINE:  missile_tow_stop  *  .  ^ 

*  PARAMETERS:  tptr  -  A  pointer  to  the  TOW  missile  that  is  to 

*  be  stopped. 

*  RETURNS:  none  *  ^ 

*  PURPOSE:  This  routine  causes  all  concerned  to  forget  ^ 

*  about  the  missile.  It  should  be  called  when 

*  the  flyout  of  any  TOW  missile  is  stopped 

*  (whether  or  not  it  has  exploded) .  Note  that  * 

*  this  routine  can  only  be  called  within  this 

★ 

*  module. 

*  * 
****************************************************************/ 

static  void  missile_tow_stop  (tptr) 

TOW_MISSILE  *tptr; 

{ 

1*1  _ 

*  Tell  the  world  to  stop  worrying  about  this  missile  then  release  the 

*  memory  for  use  by  other  missiles. 

/*/ 
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missile_util_coiran_stop_missile  (& (tptr->mptr) ,  MSL_TYPE_MISSILE) 
tptr->inptr  .  state  =  FALSE; 


) 


!  * 

★ 


*  ROUTINE:  missile_tow_cut_wire  .  .  ^ 

*  PARAMETERS:  tptr  -  A  pointer  to  the  TOW  missile  whose  wire 

*  is  to  be  cut. 

*  RETURNS:  none  _  _  ^  * 

*  PURPOSE:  This  routine  sets 'a  flag  indicating  that  tne  ^ 

*  guidance  wire  of  this  missile  is  cut. 


void  missile_tow_cut_wire  (tptr) 

TOW_MISSILE  *tptr; 

{ 

/*/ 

*  If  the  the  wire  is  not  already  cut,  cut  the  wire. 
/*/ 

'  if  { ! tptr->wire_is_cut) 

tptr->wire_is_cut  =  TRUE; 

} 
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Appendix  M  -  Source  code  listing  for  rkt_hydra.c. 

The  following  appendix  contains  the  source  code  listing  for 
rkt_hydra.c  for  convenience  in  document  maintenance  and 
imderstanding  of  the  CSU. 
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/*  SHeader:  /a3/adst-cin/RWA/AIRNET/simnet/vehicle/libsrc/libmissile/RCS/rkt_hydr 

a.c,v  1.4  1993/01/28  23:27:59  cm-adst  Exp  $  */ 

/* 

*  $Log :  rkt_hydra . c ,  v  $ 

*  Revision  1.4  1993/01/28  23:27:59  cm-adst 

*  P.  DesMeules's  changes  for  spcr  31 

* 

*  Revision  1.3  1993/01/06  21:19:06  cm-adst 

*  R.Branson's  changes  for  the  weapons  model. 

* 

*  Revision  1.1  1992/09/30  16:39:52  cm-adst 

*  Initial  Version 

* 

char  RCS  IDO  =  -SHeader:  /aS/adst-om/RWA/AIRNET/simnet/vehlcle/llbsrc/li 
SfssUe/RCS/rkI.hYdra.c,v  1.4  1993/01/28  23:27:59  cm-adat  E.p  S": 

******************  ***************** 


/ 


*  Revisions 

★ 

■kl 


Version 

Date 

Author 

1.2 

10/23/92 

R. 

Branson 

1.3 

10/30/92 

R. 

Branson 

1.4 

11/25/92 

R, 

,  Branson 

1.5 

01/19/93 

P. 

,  Desmeules 

Title 


SP/CR  Number 


zation 
3ded  pathnc 
directory 


31 


fgets  to  make  sure  the 

^  whole  line  is  read  in. 

*****************************************************************************/ 

/***************************************************************************** 

★ 

*  SP/CR  No.  Description  of  Modification 


★ 

★ 

★ 

★ 

★ 

★ 


Hard  coded  defines  changed  to  array  elements. 
Characteristics/parameter  data  array  added. 
Added  file  reads  for  rocket  characteristics/ 
parameters . 


*  Added  " /simnet/data/ “  to  each  data  file  pathname. 


,**************************************************************** 
/  * 

★  . 

* 

*  FILE:  rkt_hydra.c  ^ 

*  AUTHOR:  Kris  Bartol  ^ 

*  MAINTAINER:  Kris  Bartol  ^ 

* 
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*  PURPOSE:  This  file  contains  routines  which  govern  ^ 

*  the  behavior  of  an  Hydra70  Rocket  flown  with 

*  a  ballistic  trajectory. 

*  HISTORY:  10/06/90  kris 

* 

*  Copyright  (c)  1989  BBN  Systems  and  Technologies,  Inc. 

*  All  rights  reserved. 


# include  “stdio.h" 

# include  "math.h" 

# include  “sim_types .h" 
#include  ''sim_dfns  .h" 
#include  "basic. h" 

# include  "mun_type.h" 

# include  "librva.h" 

# include  "libmap.h" 
#include  "libmatrix.h" 
linclude  " libmiss_dfn .h" 
# include  "libmiss_loc .h" 
#include  " libmissile .h“ 

# include  "rkt_hydra .h" 


/* 

*  Debug  macro 
*/ 

#ifdef  FILEDBG 
#define  P(a)  a 

#else 

Sdefine  P(a) 

#endif 

# define  DEBUG  0 

Idefine  HYDRA_TRAJ_FILE 
idefine  HYDRA_PARAM_FILE 


/*  debugging  is  ON  */ 

“ /simnet/ data/hydra7  0 . sd" 
" /simnet/data/hydra7  0 . sp" 


/*__  Define  rocket  performance  characteristics  -*/ 
#define  HYDRA_MIN_RANGE  rkt_hydra_char [  7] 

#define  HYDRA_MAX_RANGE_S5  rkt_hydra_char [  8] 
#define  HYDRA_MAX_RANGE_M151  rkt_hydra_char [  9] 

# de f ine  HYDRA_MAX_RANGE_M2  6 1  rkt_hydra_char [10] 
[[define  HYDRA_MAX_RANGE_M2 5 5  rkt_hydra_char [  11  ] 


/*__  Define  the  states 
#define  HYDRA_FREE 
#define  HYDRA_FLY 
idefine  HYDRA_DETONATE 
idefine  HYDRA_FALL 
idefine  HYDRA_RELEASED 
idefine  HYDRA_REMOVE 


of  an  HYDRA70_ROCKET  --*/ 

0  /*  Rocket  available  to  launch  */ 

1  /*  Rocket  flying  */  ^ 

2  /*  Rocket  detonates  -  release  or  impact  J 

3  /*  Sub-munitions  falling .  ! 

4  /*  Sub-munitions  released  towards  impact  / 

2^0  /*  Rocket  gets  killed  at  end  of  this  tick  / 
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static 

{ 

M151 
M261_ 
M261 
M261 
M2  5  5_ 
M2  5  5 
FLECH 
50. 
5000  . 
7000. 
7000  . 
3200. 

}; 


REAL  rkt_hydra_char [ 


BURST_SPREAD, 
BURST_HEIGHT, 
BURST_RANGE, 
BURST_SPREAD, 
BURST_RANGE, 
BURST_SPREAD, 
_60_MAX_RANGE, 
0,  /* 

0,  /* 

0,  /* 

0,  /* 

0  /* 


/* 

/* 

/* 

/* 

/* 

/* 

/* 

hydra 

hydra 

hydra 

hydra 

hydra 


12]  = 

twin  bursts  are  3  m  apart  */ 
release  submunitions  180  ft  */ 
0  m  in  front  of  target  (49  ?)  */ 
twin  bursts  are  13  m  apart  */ 
release  darts  150  m  front  of  tgt 
twin  bursts  are  35  m  apart 
darts  fly  total  of  750  m 


*/ 

*/ 

*/ 


minimum  range  */ 
maximum  range  for  Soviet  S-5  57mm  Rocket  */ 
maximum  range  for  _M151  [actual  9000  m]  */ 
maximum  range  for  M2  61  */ 
maximum  range  for  M2 5 5  */ 


/* —  burst 
static  int 


releases  9  bombletts  -*/ 

m73_per_m261_burst  =  M73_PER_M261_BURST; 


/*—  nointer  to  &  number_of  HYDRA70_ROCKET  array  --*/  ^ 

static  HYDRA.ROCKCT  -hydra.array;  /;  missnif  */ 

Static  int  num_hydra;  /  numuci. 


/*__  array  of  pointers  to  Hydra70_Rockets  in  flight  --  / 
static  HYDRA_ROCKET  *hydra_f ly [MAX_HYDRA70_ROCKET] ; 
static  int  rkts_in_f light; 


/* —  Ballistics  Table  . . .  array  o 
static  MISSILE_BALLISTIC_OFFSETS 
static  int  table_size; 


f  structures  _MISSILE_BALLISTIC_0FFSETS_ 
ball_table [BALLISTIC_TABLE_SIZE] ; 


static  BOOLEAN  ball_table_loaded  =  FALSE; 


★ 


/ 


static  VehiclelD  null_vehicleID; 

static  int  flight_time;  /*  Time  Of  Flight  for  ballistic  tra] 


static  REAL 

max_range_limit , 
speed_f actor, 
pylon_x, 
pylon.:/, 
pylon_z ; 


/* 

/* 

/* 

/* 

/* 


[  MISSILE_US_MAX_RANGE_LIMIT  ] 

[  missile_us_speed_factor  ] 

[0.0]  <xyz>  position  offset  of  pylon 

[0.0]  */ 

[0.0]  */ 


stat?Vint  hechette_veh_list;  /*  list  ID  of  flechette  target  vehicles 


*/ 

*/ 

*/ 


*/ 


static  void  missile_hydra_stop  (); 

static  void  missile_hydra_purge_f ree_missiles  (); 


/ 


•k 


*  ROUTINE:  missile_hydra_init 

*  PARAMETERS:  rocket_array  -  Array  of  rockets  of  s  rue  ur 

*  type  _HYDRA_ROCKET_ 

*  num_rockets  -  The  number  rockets  defined  in  * 

*  _rockets_array_. 

*  RETURNS:  none 
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*  PURPOSE:  This  routine  copies  the  parameters  into 

*  variables  static  to  this  module  and  initializes 

*  the  state  of  all  the  rockets.  * 


void  missile_hydra_init{  rocket_array ,  num_rocket  ) 

HYDRA_ROCKET  *rocket_array ; 
int  num_rocket; 

{ 

int  i  ; 

int  data_tmp_int ; 
float  data_tmp; 
char  descript [80] ; 

FILE  *fp; 

P{printf (“$$$$  HYDRA  rocket  file  data  $$$$\n");); 

/*  DEFAULT  CHARACTERISTICS  DATA  FOR  rkt_hydra.c  READ  FROM  FILE 
fp  =  fopen{“/simnet/data/rkt_hydr.d”, "r") ; 

if  {fp==NULL)  {  ,  ,  ,  _  u  J  i.  \ 

'  fprintf (stderr,  "Cannot  open  /simnet/data/rkt_hydr .d\n 

exit { ) ; 

} 

rewind (fp) ; 

/*  Read  array  data  */ 

fscanf (fp, "%d" ,  &data_tmp_int); 
m73_per_pi261_burst  =  data_tmp_int  ; 
fgets (descript,  80,  fp) ; 

P(printf (•m73_per_m261_burst  is%3d  %s",  m73_per_m261_burst, 
descript) ; ) ; 


while(fscanf  (fp,  "%f'',  &data_tmp)  !=EOF){ 
rkt_hydra_char [ i ]  =  data_tmp ; 
fgets (descript,  80,  fp); 

P (printf ( "rkt_hydra_char (%3d)  is%11.3f  %s",  i, 

rkt_hydra_char [ i ] ,  descript) ; ) ; 


/* 


fclose ( fp) 
END  DEFAULT 


CHARACTERISTICS  DATA  FOR  rkt_hydra.c  READ  FROM  FILE 


hydra_array  =  rocket_array ; 

num_hydra  =  num_rocket  <  MAX_HYDRA7 0_ROCKET  ? 

num_rocket  :  MAX_HYDRA7 0_ROCKET ; 
for  (i  =  0;  i  <  MAX_HYDRA7 0_ROCKET ;  i++) 

hydra_array [i] .bmptr. state  =  HYDRA_FREE; 

hydra_array [ i ] .bmpr t .raissile_id  =  0 ; 


*/ 
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rkts_in_f light  =0;  /*  no  missiles  in  flight  */ 

for{  i  =  0;  i  <  MAX_HYDRA70_ROCKET;  i++  ) 
hydra_fly[i]  =  0; 


pylon_x  =  0.0; 
pylon_y  =  0.0; 
pylon_z  =  0.0; 
flight_time  =  0; 

speed_f actor  =  MISSILE_US_SPEED_FACTOR; 
n)ax_range_limit  =  MISSILE_US_MAX_RANGE_LIMIT, 


if  { !ball_table_loaded) 

{ 

★ 

*  load  HydraVO  Rocket's  ballistic  table 
*/ 

printf(  "loading  Hydra70  Rocket's  ballistic  table  %s\n“, 
HYDRA_TRAJ_FILE  ) ; 
t  ab 1 e  size  — 

mTssile_util_load_ball_traj_file(  HYDRA_TRAJ_FILE,  ball_table 
'  ball_table_loaded  =  TRUE; 

) 


)  ; 


/* 

*  create  _f lechette_veh_list_  for  proximity  fuze 

'  flechette_veh_list  =  rva_create_output_list {  f lechette_is_valid_veh  ); 

#ifdef  notdef 

f lechette_veh_list  =  RVA_ALL_VEHICLES_LIST; 

#endif 

' *  initialize  the  proximity  fuze  for  rockets  armed  with  Flechette's 

*/ 

missile_fuze_prox_init { ) ; 

} 

int  missile_hydra_is_free{  rocket  ) 
int  rocket; 

return{  (hydra_array [rocket] .bmptr .state  ==  HYDRA_FREE  )), 

} 


^ **************************************************************** 

*  ROUTINE:  missile_hydra_set_pylon_position_of f sets 

*  PARAMETERS:  x  =  X  offset  (in  meters  ) from  center  of  HUL  .  ^ 

*  y  =  Y  offset.  ^ 

*  z  =  Z  offset.  ^ 

*  RETURNS:  none.  * 

*  PURPOSE:  Sets  the  X,  Y  and  Z  offsets  from  center  of  ^ 

*  HULL  for  trajectory  calculations. 

************************************************************** 


void  missile_hydra_set_pylon_position_offsets{  x,  y,  z  ) 

REAL  X,  y,  z; 


•k 


/ 


-M-6- 


Reference# W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


APPENDIX  M  -  rkt_hydra.c 


pylon_x  =  X; 
pylon_Y  =  y; 
pylon_z  =  z; 


void  miss ile_hydra_set_speed_f actor (  speed_scale  ) 
REAL  speed_scale; 

{ 

speed_f actor  =  speed_scale ; 

} 


void  missile_hydra_set_max_range_limit(  limit_range  ) 
REAL  limit_range; 

{ 

max_range_limit  =  limit_range; 

} 


★ 


************************************************  ************* 
*  ROUTINE:  missile_hydra_set_pylon_articulation 
PARAMETERS :  tgt_range  -  Range  to  target . 

r-kt_type  -  Type  of  Rocket  to  be  launched, 
time  -  Pointer  to  Time  Of  Flight 

variable  in  vehicle-spec  code,  [int] 
se_angle  -  Pointer  to  Super  Elevation 

variable  in  vehicle-spec  code.  [REAL] 
lead_angle  -  Pointer  to  Lead  Elevation 

variable  in  vehicle-spec  code.  [REAL] 


RETURNS :  none .  ,  ^  . 

PURPOSE:  Sets  _laser_range_  of  next  Hydra70  rocket  to  ^ 

be  launched  and  calculates  Time  Of  Flight,  ^ 

Super  Elevation  angle  and  Lead  angle  for  next 
*  rocket  launch. 

****************************************************************/ 


void  missile_hydra_set_pylon_articulation{  tgt_range,  rkt_type,  time, 

se_angle,  lead_angle  ) 

REAL  tgt_range ; 

int  rkt_type,  *time; 

REAL  *se_angle,  *lead_angle; 

REAL  range;  /*  Range  to  target  */  _  .  t  , 

REAL  ball_range;  /*  Range  to  look-up  in  Ballistic  Table  / 

if (  tgt_range  <  HYDRA_MIN_RANGE  ) 
range  =  HYDRA_MIN_RANGE; 
else  if{{  max_range_limit  >  0.0  )  && 

(  tgt_range  >  max_range_limit  )  ) 

range  =  max_range_limit; 

else 

range  =  tgt_range; 

/*  SuperElevation  &  TOF  for  each  Rocket  Type  */ 
switch!  rkt_type  ) 

{ 
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/*  tvDS  101b  WARHEAD  */ 
case  R0CKET_HE:  ' 

if(  range  >  HYDRA_MAX_RANGE_M151  ) 
range  =  HYDRA_MAX_RANGE_M151 ; 
ball  range  =  range  /  speed_factor ; 

inissile_util_ballistics_calc_traj {  ball_table,  table_size, 

ball_range,  0.0,  0.0, 
time,  se_angle  ) ; 

*lead_angle  =  atan(  (rkt_hydra_char [  0]  - 

*time  =  -5;  /*  have  a  timed  fuze  / 

break;  tVDe  MPSM  */ 

if(  range  >  HYDRA_MAX_RANGE_M261  ) 
range  =  HYDRA_MAX_RANGE_M2 6 1 ; 
ball  range  =  range  /  speed_f actor ; 

missile_util_ballistics_calc_traj (  ball_table,  table  size, 

ball_range,  0.0,  rkt_hydra_char [  1], 
time,  se_angle  ) ; 

*lead_angle  =  atan (  {rkt_hydra_char [  3]  -  pylon_x)  /  range  ) ; 

case^SKET.FLECHETTE;  /*  ^^^P®  PLECHETTE  */ 

if{  range  >  HYDRA_MAX_RANGE_M255  ) 

range  =  HYDRA_MAX _ RANGE — M2 55; 

ball_range  =  range  /  speed_factor ;  , ,  ^  ^ 

time,  se_angle  ) ; 

*lead_angle  =  atan ( {rkt_hydra_char [  5]  -  pylon  x)  / 

(range  -  rkt_hydra_char [  4])); 

break; 

‘^^^^printf{  “hydra_set_pylon_articul:  unknown  warhead_type  %d\n“,  rkt_type  ); 

*time  =  0; 

*se_angle  =  0.0; 

*lead_angle  =  0.0; 
break; 

) 

flight_tirae  =  *time; 


} 


/*******************************************************;******** 

*  ROUTINE:  miss ile_hydra_f ire 

*  PARAMETERS:  rkt_type  -  Type  of  Rocket  warhead.  ^ 

*  ammo  -  Ammo  Type  of  rocket's  warhead.  ^ 

*  launch_pt  -  The  location  in  world  ^ 

■k  coordinates  that  the  rocket  is 

*  launched  from. 

*  launch_or lent  -  The  sight  to  world ^ 

*  transformation  matrix  used 

*  only  in  this  routine. 

*  launch_speed  -  Speed  of  launch  platform 

*  (assumed  to  be  in  the  direction 

*  of  the  Rocket) . 


★ 

★ 


*  RETURNS:  TRUE  if  successful,  FALSE  if  not. 


-M-8- 


Reference  #W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


APPENDIX  M  -  rkt_hydra.c 


*  PURPOSE:  This  routine  performs  the  functions  „vnRA7n  * 

*  specifically  related  to  the  firing  of  a  HYDRA70 

int  miss ile_hydra_f ire (  rkt.type,  ammo,  launch_pt, 

launch_orient,  launch_speed  ) 

int  rkt_type; 

ObjectType  ammo; 

VECTOR  launch_pt ; 

T_MAT_PTR  launch_orient ; 


/*  munition_specif ic  SuperElevation  angle  */ 
/*  munition_specif ic  (+/-)Lead  angle  */ 

/*  munition_specif ic  FlightTime  */ 


REAL  launch_speed; 

{ 

T_MATRIX 

launch_lead, 
launch_se ; 

REAL 

se_angle, 
lead_angle; 
int  time; 

HYDRA_ROCKET  *rkt; 

'  BALLISTIC_MISSILE  *bmptr; 

ObjectType  fuze; 
int  i,  valid_msl; 

/*  get  next  FREE  rocket  */ 
valid_msl  =  0; 

rkt  =  hydra_array ;  ,  .  , ^  ^ 

for(  i  =  0;  i  <  MAX_HYDRA7 0_ROCKET ;  i++,  rkt++  ) 
if{  rkt->bmptr . state  ==  HYDRA_FREE  ) 

{ 

#if  DEBUG 
iendif 

} 


valid_msl  =  1; 

hydra_fly [rkt s_in_f light]  =  rkt; 

bmptr  =  &{rkt->bmptr) ; 

printf{  "Launching  Rocket  %d\n'',  i  ); 

/*  rkts_in_flight  ==  #  flying  */ 


rkts_in_flight++; 

break; 


/*  no  available  missile  to  launch  / 


if(  !valid_msl  ) 

{ 

return {  FALSE  ) ; 

) 

/*  set  MaxRange  for  Rocket  Type  */ 
switch]  rkt_type  ) 

Lse  ROCKET_HE:  /*  High  Explosive  */ 

bmptr->max_range  =  HYDRA_MAX_RANGE_M151 , 
rkt->sub_mun_type  =  SUB_MUN_NONE ; 
rkt->sub_ammo_type  =  0; 
fuze  =  munition_US_M433 ; 

/*  Multi-Purpose  Sub-Munition  */ 
case  R0CKET_MPSM:  '  Muiui  ru  p 
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bmptr->max_range  =  HYDRA_MAX_RANGE_M261 ; 
rkt->sub_mun_type  =  SUB_MUN_IMPACT ; 
rkt->sub_ammo_type  =  munition_US_M73; 
rkt->sub_munition . impact .ammo  =  munition_US_M73; 
rkt->sub_munition. impact. fuze  =  munition_US_M433; 
rkt->sub_munition . impact .quantity  =  m73_per_m261_burst; 
rkt->sub_munition . impact .height  =  rkt_hydra_char [  1], 

fuze  =  munition_US_M439 ; 

case^SxET.FLECHETTE:  /*  Flechette  discharging  warhead  */ 

bmptr->max_range  =  HYDRA_MAX_RANGE_M2 5 5 ; 
rkt->sub_mun_type  =  SUB_MUN_CANISTER; 
rkt->sub_ammo_type  =  munition_US_Flechette_60 ; 
rkt->sub_munition. dart .ammo  =  munition_US_Flechette_60; 
rkt->sub_munition . dart . fuze  =  0; 
fuze  =  munition_US_M439 ; 
break; 

default :  „  ..  1  \ 

printf{  ''hydra_f  ire_rkt :  unknown  rocket_type  %d\n  ,  rkt_type  )  ; 

rkts_in_f  light--  ; 

bmptr  ->  state  =  HYDRA_FLY; 

I  return (  FALSE  ) ; 

break ; 

mat_copy(  launch_orient,  bmptr->launcher_C_world  ) ; 

mat_copy(  launch_orient,  bmptr->orientation  ); 

vec_copy (  launch_pt,  bmptr->location  ); 

bmptr->speed  =  launch_speed;  _  _  _  ■  ■ ^ 

j*  __  Tell  the  rest  of  the  world  about  the  firing  of  this  B-missile. 

*  --  If  this  cannot  be  done,  return  FALSE.  — 

*/ 


if  (  !missile_util_coinm_f  ire_missile 
{  bmptr,  MSL_TYPE_BALLISTIC, 
map_get_ammo_entry_from_network_type (  ammo  ), 

ammo,  ammo, /*guises*/ 

&(null_vehicleID) ,  0/*targ_type*/ ,  fuze,  0/*tube*/  )) 

{ 

rkts_in_f light-- ; 

bmptr  ->  state  =  HYDRA_FLY; 

return {  FALSE  ) ; 

} 


bmptr  ->  max_f light_time  =  f light_time; 


bmptr  ->  ammo_type  =  ammo; 
bmptr  ->  time  =  0; 
bmptr  ->  ball_index  =  0; 
bmptr  ->  state  =  HYDRA_FLY; 
return {  TRUE  ) ; 


/*  initialize  in-flight  timer  */ 
/*  first  point  into  Ball-table  */ 
/*  rocket  is  now  flying  */ 


/ 


*  ROUTINE: 

*  PARAMETERS: 

*  RETURNS: 


mi s  s i 1 e_hy dr a_f ly_rocke t  s 
none 
none 


★ 


* 


★ 
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*  PURPOSE:  This  routine  flys  out  all  rockets  that  are  in 

*  a  flying  state 
************************* 


void  n\issile_hydra_f  ly_i"ockets  { ) 


register  int  i; 

int  at_least_one_empty_MPSM; 

/*  Fly  out  all  launched  &  flying  rockets. 

*  --  may  have  to  also  'fly  out'  all  released  submunitions 

*/ 

at_least_one_empty_MPSM  =  FALSE; 
for{  i  =  0;  i  <  rkts_in_f light ;  i++  ) 

switch (  hydra_f ly [ i ] “>bmptr . state  ) 

{ 

case  HYDRA_FREE; 

hydra_fly[i] ->bmptr. state  =  HYDRA_REMOVE ; 
break; 

case  HYDRA_FLY: 

.  missile_hydra_fly(  hydra_fly[i]  ); 

break; 

case  HYDRA_DETONATE : 

switch (  hydra_f ly [ i ] ">sub_ammo_type  ) 

kse  munition_US_M73:  /*  MPSM  bomblets  */ 

missile_m73_init 

{  &{hydra_fly[i]->bmptr) , 

&{hydra_fly[il->sub_munition)  ,  ^ 

ball_table[  hydra_f ly [ i ] ->bmptr .ball_index  ]. speed  ); 
hydra_fly [i] ->bmptr.state  =  HYDRA_FALL; 

case^muStion_US_Flechette_60:  /*  FLECHETTE  darts  */ 

missile_f lechette_init 

(  & (hydra_fly [i] ->bmptr) , 

&(hydra_fly[i]->sub_munition)  , 

ball_table[  hydra_f ly [ i ] ->bmptr .ball_index  ] .speed  ); 
hydra_f ly [ i ] ->bmptr .state  =  HYDRA_RELEASED ; 
break ; 

default:  \  j  \  . 

printf{  "Hydra_Detonate :  R_%d  unknown  ammo-type\n  ,i  ;; 

missile_hydra_stop {  hydra_fly[i]  ); 
break; 

} 

break; 

case  H Y  DR A_F ALL : 

switch {  hydra_fly[i]->sub_ammo_type  ) 

case  munition_US_M73 :  /*  type  MPSM  / 

if(  missile_m73_drop(  & {hydra_f ly [ i] ->bmptr) , 

St(hydra_flY[i] ->sub_munition)  )) 
hydra_fly[i]->bmptr.state  =  HYDRA_RELEASED ; 
break; 
default : 
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printf(  "Hydra.FallO :  R_%d  bad  sub_munition\n” ,  i  ); 

inissile_hydra_stop (  hydra_fly[i]  ); 

break; 


} 

break; 

case  HYDRA_RELEASED ; 

switch (  hydra_fly[i]->sub_amino_tYpe  ) 


{ 

case  munition_US_M73 : 

if{  !  inissile_m73_impact  ( 


/*  type  MPSM  */ 
&(hydra_fly[i]->binptr)  , 

& (hydra_f ly [ i] ->sub_munition) 


)  ) 


at_least_one_empty_MPSM  =  TRUE; 
missile_hydra_stop {  hydra_fly[i]  ); 


} 

break ; 

case  inunition_US_Flechette_60:  _  r  1 

5ile  flechette_fly(  & (hydra_f ly [ i] ->bmptr ) 


/ *  type  FLECHETTE  * / 


if  { 


miss] 


&{hydra_fly [i] ->sub_munition) 

f lechette_veh_list  ) ) 


I 


/* 


missile_hydra_stop {  hydra_fly[i]  ) ; 
missile_fuze_prox_stop  ^  ^ 

{  & (hydra_fly [i] ->sub_munition.dart .pptr)  ); 


} 

break; 

default: 

printf(  “Hydra_Release:  R_%d  bad 
missile_hydra_stop{  hydra_fly[i] 
break ; 


sub_munition\n" 

)  ; 


i  )  ; 


} 

break; 

case  HYDRA_REMOVE : 


break; 
default : 

printf(  "Msl_hydra_fly_rkts() : 
miss ile_hydra_s top {  hydra_fly[ 
break; 


rkt_%d  not 
i]  ); 


} 

Send  out  remaining  (if  any)  Indirect  Fire  pkts  */ 

if(  at_least_one_empty_MPSM  ) 

network_if ire_send_indirect_f ire ( ) ; 


f lying\n" , 


i  )  ; 


/*  Get  rid  of  DEAD  rockets  */  _ 

missile_hydra_purge_free_missiles ( )  ; 

} 


/ 


***************************************************************; 

*  ROUTINE:  missile_hydra_f ly 

*  PARAMETERS:  rkt  -  Pointer  to  a  _HYDRA_ROCKET_  s  rue  ure  ^ 

*  RETURNS:  none  _  ^ 

*  PURPOSE:  This  routine  performs  the  functions  * 

*  specifically  related  to  the  flying  an  HYDRA70 
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*  and  frees  up  the  Rocket  for  another  launch. 

****************************************************************/ 


static  void  missile_hydra_stop {  rkt  ) 

HYDRA_ROCKET  *rkt; 

{ 

BALLISTIC_MISSILE  *bmptr; 
int  i  ; 

bmptr  =  Sc{  rkt->bmptr  ); 

*  Tell  the  world  to  stop  worrying  about  this  missile  then  release  the 

*  memory  for  use  by  other  missiles. 

missile_util_comm_stop_missile(  bmptr,  MSL_TYPE_BALLISTIC  ); 

pSSf(  "Stop::  T:  %d  Rkt:  %d  Pos  :  %1.21f  %1 . 2  If  %1 . 2  If \n“  , 
bmptr->time,  bmptr->missile_id,  bmptr->location [ 0 ] , 
bmptr->location [ 1] ,  bmptr->location [2 ]  ) ; 

#endif 

/<* 

*  Mark  rocket  to  be  Removed 
*/ 

bmptr->state  =  HYDRA_REMOVE; 

} 

static  void  missile_hydra_purge_free_missiles { ) 

{ 

int  i  ; 
i  =  0; 

while!  i  <  rkts_in_f light  ) 

if(  hydra_fly[ i] ->bmptr. state  ==  HYDRA_REMOVE  ) 

{ 

/* 

*  Swap  — BAD--  rocket[i]  with  — LAST--  rocket [rkts_in_f light] 

*  Cut-off  {now  BAD)  —LAST--  rocket 

*  Check  (now  Good)  rocket [i] 

*/ 

hydra_fly [ i] ->bmptr .state  =  HYDRA_FREE; 
rkts_in_f light-- ; 

hydra_fly[i]  =  hydra_fly[rkts_in_flight]; 
hydra_fly[rkts_in_f  light]  =  0; 

) 

else 

/* 

*  Check  next  rocket [i+1] 

*/ 

i++; 

} 

} 
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void  mbmat {  mat  ) 

T_MAT_PTR  mat; 

{ 

int  i ,  j ; 

for(  i=0;  i<3;  i++  ) 

{ 

for(  j=0;  j<3;  j++  ) 

printf(  “  %1.41f  ",  mat[i][j]  ); 

printf(  "\n'‘  )  ; 

} 


void  mbmat_nan{  mat  ) 

T_MAT_PTR  mat; 

{ 

int  i,  j; 
union  foo 
{ 

REAL  df; 
long  1 [2 ]  ; 

}  x; 

t 

for(  i=0;  i<3 ;  i++  ) 

{ 

for{  j=0;  j<3;  j++  ) 

printf {  "  %1.41f  ",  mat[i] [j]  ) ; 

printf{  ); 

for,(  j=0;  j<3;  j++  ) 

{ 

x.df  =  mat [ i] ( j ] ; 

printf {  "  0x%08x  0x%08x",  x.l[0],  x.l[l]  ); 

} 

printf {  "\n"  ); 

} 

) 

void  mbm{  n,  msg  ) 
int  n; 
char  msg [ ] ; 

{ 

printf (  "BM:  %d  ->  %s\n",  n,  msg  ); 

} 

void  mbfl(  n,  msg  ) 

REAL  n; 
char  msg [ ] ; 

{ 

printf (  "BM:  %6.41f  ->  %s\n",  n,  msg  ); 

} 
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imderstanding  of  the  CSU. 
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/*  $Header;  /a3 /adst-cm/RWA/AIRNET/simnet/vehicle/rwa/src/RCS/rwa_hydra . c , v  1.4 

1993/01/28  23:33:00  cm-adst  Exp  $  */ 

/* 

*  $Log:  rwa_hydra . c , V  $ 

*  Revision  1.4  1993/01/28  23:33:00  cm-adst 

*  P.  DesMeueles's  changes  for  spcr  31 

* 

*  Revision  1.3  1993/01/06  21:29:20  cm-adst 

*  R.Branson's  changes  for  the  weapons  model. 

* 

*  Revision  1.1  1992/09/30  17:02:58  cm-adst 

*  Initial  Version 

* 

ILtlc  char  RCS  ID(1  =  "SHaader:  /aS/adst-cm/RWA/AIRNET/sinmet/vehlcls/rwa/src/R 

Js%iLhydra  =,v  I'i  1993/01/28  23:33,00  cm-adst  Exp  S'; 

t***************************************** 


★ 

*  Revisions: 

★ 


★ 

Version 

Date 

Author 

★ 

★ 

1.2 

10/23/92 

R .  Branson 

* 

★ 

★ 

1.3 

10/30/92 

R.  Branson 

★ 

★ 

1.5 

01/19/93 

P .Desmeules 

Title 


SP/CR  Number 


zation 
aded  pathnc 
directory 


31 


fgets  to  make  sure  the 
*  whole  line  is  read 


SP/CR  No, 


Description  of  Modification 


Hard  coded  defines  changed  to  array  elements. 
Characteristics/parameter  data  array  added. ^ 

Added  file  reads  for  hydra  rocket  characteristics/ 
parameters . 

Added  " /simnet/data/ "  to  each  data  file  pathname. 


/***************************** 

*  SYSTEM  NAME:  rwa 

*  FILE:  rwa_hydra.c 

*  AUTHOR:  Kris  Bartol 

* 

*  SIMNET  simulation  of  Hydra70  Rocket 


* 
★ 
* 
★ 
★ 
★ 
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*  Copyright  (c)  1990  BBN  Advanced  Simulation  Division. 

*  All  rights  reserved. 


jjinclude  " simstdio .h" 

# include  ‘'sim_types  .h" 

# include  " sim_dfns .h" 

# include  "sim_macros .h“ 
#include  "basic. h" 

# include  "mun_type.h“ 

# include  "veh_type.h" 


#include  " libmatrix .h" 

# include  "libmath.h" 

# include  “ librotate .h“ 

# include  " libturret .h" 
#include  "libhull.h" 
#include  "libkin.h" 

# include  "libcig.h" 
#include  "libimps.h" 

# include  "libmap.h" 
#tnclude  " libmissile .h" 
#include  “ libmiss_dfn .h" 
# include  " rkt_hydra . h " 


#include  "rwa_kinemat .h" 
# include  "rwa_weapons .h“ 
# include  "rwa_meter .h" 

# include  "rwa_conf ig .h" 


/* 

*  Debug  macro 
*/ 

#ifdef  FILEDBG 
#define  P(a)  a 

#else 

#define  P{a) 

#endif 

#define  DEBUG  0  /*  debugging  is  ON  */ 

# define  LEFT  0 

idefine  RIGHT  1 

# define  NUM_ROCKETS_LAUNCHED_PER_TICK  2 

/*/ 

*  Define  rocket  characteristics. 

/*/ 

#define  HYDRA_LAUNCHER_POS_X  hydra_rkt_char [ 0 ] 
#define  HYDRA_LAUNCHER_POS_y  hydra_rkt_char [ 1 ] 
#  de  f ine  HYDRA_LAUNCHER_POS_Z  hydra_rkt_char [ 2 ] 
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*  Articulation  Limits  are  +4  to  15  degrees  but  are  adjusted  to 

*  +19  to  -15  degrees  for  simulation's  fixed  OTW  reticle 


*  ***★*/ 

idefine  SOVIET_ARTICULATION  { 
#define  HULL_NEG_5_PITCH  ( 
#define  ARTICULATION_MAX  ( 
#define  ARTICULATION_MIN  ( 


inil_to_rad (hydra_rkt_char [3 ] ) ) 
deg_to_rad(hydra_rkt_char [4] ) ) 
deg_to_rad{hydra_rkt_char [5] ) ) 
deg_to_rad{hydra_rkt_char[6] ) ) 


' *  Hydra  rocket  characteristic  parameters  initialized  to  default  values 
/*/ 

static  REAL  hydra_rkt_char [7 ]  = 

4.5,  /*  hydra  launcher  position  X  */ 

0.5,  /*  hydra  launcher  position  Y  */ 

-2.0,  /*  hydra  launcher  position  Z  */ 

104.0,  /*  mils  of  Soviet  articulation  */ 

_5_0,  /*  degrees  of  hull  negative  pitch  */ 

2^9  /*  degrees  of  maximum  articulation  */ 

-15.0  /*  degrees  of  minimum  articulation  */ 

ROTATE_ELEMENT_DEF  {articulation_element) ; 

ROTATE_ELEMENT_DEF  {pylon_L_element) ; 

ROTATE_ELEMENT_DEF  (pylon_R_element ) ; 

static  HYDRA_ROCKET  hydras [MAX_HYDRA70_ROCKET  +  1]  =  {  0  }; 


static  VehiclelD  null_VehicleID; 
static  int  f light_time ;  /* 

static  REAL 

super_elevation,  /* 

target_range;  /* 


Time  Of  Flight  for  ballistic  traj  */ 

Adj  angle  for  ballistic  traj  */  _ 

Range  by  which  to  calculate  ballistics  */ 


static  ObjectType  ammo_type; 
static  int  warhead_class ; 


/*  Ainrao_Type  of  rockets  to  be  launched  */ 
/*  one  of  [  HE  I  MPSM  I  FLECHETTE  ]  */ 


static  int  pylons_set; 

static  int  left_rocket_launch; 

static  int  right_rocket_launch; 


/*  TRUE  when  pylon  articulation  is  complete  */ 
/*  TRUE  — >  launch  left  rocket  */ 

/*  TRUE  — >  launch  right  rocket  */ 


static  VECTOR  lef t_launcher_pos  =  { 
static  VECTOR  r ight_launcher_pos  = 
static  VECTOR  articulation_pos  =  { 


4.5,  0.0,  0.0  ); 

{  4.5,  0.0,  0.0  }; 
0.0,  0.5,  -2.0  ); 


extern  REAL  weapons_get_rocket_range { ) ; 
extern  REAL  kinematics_get_true_airspeed () ; 
extern  void  mbmat ( ) ; 
extern  void  mbmat_nan ( ) ; 
extern  void  mbvec { ) ; 

ROTATE_ELEMENT  *articulation { ) 

{ 
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return (  &articulation_element  ); 

) 

ROTATE_ELEMENT  *pylon_L() 

{ 

return {  &pylon_L_element  ) ; 

) 

ROTATE_ELEMENT  *pylon_R { ) 

{ 

return (  £:pylon_R_element  I; 


void  hydra _ launch _ rocket — left() 

left_rocket_launch  =  TRUE; 

} 


void  hydra_launch_rocket_right{) 
'  right_rocket_launch  =  TRUE; 

} 


int 

int 

{ 


hydra_launch_rocket 
launch_f  rom_r ight ; 


launch_froro_right  )  _  •  ,  ,  v 

/*  0  =  left-side  (neg)  : :  1  =  right-side  (pos) 


T_MAT_PTR  launch_orient; 
VECTOR  launch_velocity ; 
REAL 

*launch_point, 

se_angle, 

lead_angle; 


*/ 


/*  get  launch_point  &  launch_orient  */  .  / 

if(  launch_froin_right  )  /*  launch  from  right  / 

launch_point  =  rotate_get_loc {  world{),  pylon_R()  ) ; 
launch_orient  =  rotate_get_mat (  pylon_R{),  world ()  ), 

) 

else 

launch_point  =  rotate_get_loc {  worldO,  pylon_L()  )  ; 
launch_orient  =  rotate_get_mat (  pylon_L(),  world ()  }; 


) 

#if  DEBUG  _ 

if{  mat_check(launch_orient)  ==  FALSE  ) 
mbmat_nan(  launch_orient  ); 


iendif 
if  { 


i miss ile_hydra_f ire {  warhead_class ,  ammo_type, 

launch_point ,  launch_orient , 

{kinematics_get_true_airspeed{) /15) 


{ 

#if  DEBUG 

printf ( 


"No  memory 


in  missile_comm  for  HYDRAXn"); 


/*init  speed*/) ) 


-N-5- 


Reference  #W003092;  31  March  1993 
VOLUME  1  of  3;  Rev.  0.0 


APPENDIX  N  -  rwa_hydra.c 


#endif 

printf(  "Rocket  launch  failed\n“  ); 
return {  FALSE  ) ; 

} 

return {  TRUE  ) ; 

} 

int  hydra_pYlons_are_set { ) 

{ 

return (  pylons_set  ) ; 

) 


void  hydra_set_pylon_articulation (  WAS_position  ) 
int  WAS_position; 

( 


$ 


MUNITION_DATA  * 
int  flight_time 
REAL 

range, 

super_elev, 

dispersion; 


mun_data ; 

/*  time  of  flight  to  fly  _range_  meters 
/*  range  to  target  */ 

/*  super  elevation  angle  for  trajectory 
/*  dispersion  angle  for  trajectory  */ 


/* 

*  Given  _range_  &  _ammo_type_  : :  .  .  t 

*  *  calculate  and  return  super_elev  &  dispersion  angles 

*  *  calculate  and  set  Time-Of-Flight  timer 

*  *  set  _ammo_type_  of  next  rocket (s)  to  be  fired 

*  / 

mun_data  =  rwa_conf ig_get_was_munition_info  {WAS_position) ; 
ammo_type  =  mun _ data“>munition — type; 


*/ 


*/ 


if  (mun_data->code  !=  MUNITION_ROCKET) 
/*  bombs,  for  example  */ 
return; 


switch (mun_data->data . rocket .warhead) 

{ 

case  WARHEAD_HE : 

warhead_class  =  R0CKET_HE; 
break; 

case  WARHEAD_MPSM ; 

warhead_class  =  ROCKET_MPSM; 
break ; 

case  WARHEAD_FLECHETTE : 

warhead_class  =  ROCKET_FLECHETTE ; 
break; 
default; 

printf{  "hydra_set_artic :  unknown  warhead  %d  for  WAS  %a\n  , 
mun_data->data. rocket. warhead,  WAS_position  ); 

break; 

} 

^  *  Get  rocket  range  &  calculate  SuperElevation  and  Dispersion  angles 
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pylons_set  =  FALSE; 

if{  mun_data->data. rocket. articulation  ) 
range  =  weapons_get_rocket_range { ) ; 

slSG 

range  =  (REAL) (mun_data->data . rocket . flyout_range) ; 

*  Set  pylon  Super  Elevation  angle  &  pylon  Dispersion  angle 

missile  hydra_set_pylon_articulation {  range,  warhead_class ,  &f light_time, 

&super_elev,  &:dispersion  )  ; 

super_elev  +=  HULL_NEG_5_PITCH; 

rotate_set_angle {  articulation () ,  super_elev  ); 
rotate_set_angle(  pylon_R(),  (-dispersion)  ) ; 
rotate_set_angle (  pylon_L{),  dispersion  ); 


void  hydra_conf ig_rockets { ) 

{ 

MUNITION_DATA  *mun_data; 
int  i  ; 

( 

for{  i  =  0;  i  <  MAX_WAS_POSITIONS;  i++  ) 

^  if{  (mun_data  =  rwa_conf ig_get_was_munition_info {  i  ) )  ==  NULL  ) 

continue; 

if {  mun_data->code  ==  MUNITION_ROCKET  ) 

{ 

miss ile_hydra_set_speed_f actor 

(  (REAL) (mun_data->data. rocket. speed_f actor)  ); 
miss i le_hydra_set_max_range_l imi t 

(  (REAL) (mun_data->data. rocket . flyout_range)  ); 


void  hydra_init  {) 

{ 

int  i  ; 

int  data_tmp_int; 
float  data_tmp; 
char  descript [80] ; 
FILE  *fp; 


P (printf { " $$$$  HYDRA  file  data  $$$$\n");); 


/*  DEFAULT  CHARACTERISTICS  DATA  FOR  rwa_hydra . c  READ  FROM  FILE 

fp  =  fopen('‘/simnet/data/rwa_hydr.d",  ”r")  ; 

if  (fp  =  =NULL)  {  ,  ,  V  . 

fprintf (stderr,  "Cannot  open  /simnet/data/rwa_hydr .d\n  ), 

exit { ) ; 

} 

rewind { fp) ; 
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/*  Read  array  data  */ 
i  =  0; 


while(fscanf  (fp, &data_tmp)  !=EOF){ 
hydra_rkt_char  [  i  ]  =  data_tinp; 
fgets (descript,  80,  fp); 

P  (printf  { ''hydra_rkt_char  (%3d)  is%11.3f  %s",  i, 

hydra_rkt_char [ i ] ,  descript ) ; ) ; 

++i ; 

} 

/*  ENd'^  DEFAULT  ^CHARACTERISTICS  DATA  FOR  rwa_hydra  .  c  READ  FROM  FILE 

lef t_launcher_pos [ 0 ]  =  HYDRA_LAUNCHER_POS_X; 

right_launcher_pos [ 0 ]  =  HYDRA_LAUNCHER_POS_X; 

articulation_pos [ I ]  =  HYDRA_LAUNCHER_POS_Y ; 

articulation_pos [2 ]  =  HYDRA_LAUNCHER_POS_Z ; 


t 


} 


i f ( I rotate_init_elenieht {  &articulation_element ,  hull(), 

1.0,  0.0,  0.0,  0.0, 

ARTICULATION_MIN, ARTICULATION_MAX, /*TWO_*/PI, /*rate*/ 
0.0,  HYDRA_LAUNCHER_POS_Y,  HYDRA_LAUNCHER_POS_Z  )) 


printf {  "Rotate_Init_Element :  articulation_element  FAILED\n  ), 


'otate_init_element(  &pYlon_L_element,  articulation () ,  0.0,  0.0,  1.0,  0.0, 

-TWO_PI,  TWO_PI,  TWO_PI,  /*rate*/ 
-HYDRA_LAUNCHER_POS_X,  0.0,0.0); 

rotate_init_element (  &pylon_R_e lament,  articulation () ,  0.0,  0.0,  1.0,  0.0, 

-TWO_PI,  TWO_PI,  TWO_PI,  /*rate*/ 

HYDRA_LAUNCHER_POS_X,  0.0,  0.0  ) ; 

Tiissile_hydra_init  (  hydras,  MAX_HYDRA7 0_ROCKET  )  ; 

Tiissile  hydra_set_pylon_position_offsets(  HYDRA_LAUNCHER_POS_X , 

“  HYDRA_LAUNCHER_P0S_Y , 

T  ATTMr*UT?D  POQ  7.  \  ? 


hydra_conf ig_rockets ( ) ; 
lef t_rocket_launch  =  FALSE; 
right_rocket_launch  =  FALSE; 
pylons_set  =  FALSE; 


void  hydra_simul { ) 

{ 

missile_hydra_f ly_rockets ( ) ; 


if{  !pylons_set  ) 

{ 

pylons_set  =  TRUE; 

rotate_set_no_rotate {  pylon_R()  ); 
rotate_set_no_rotate {  pylon_L()  ); 
rotate_set_no_rotate {  articulation ( )  ) ; 

} 
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else 

if{  left_rocket_launch  ) 

i f (  hydra_launch_rocket {  LEFT  )  ) 

left_rocket_launch  =  FALSE; 
if(  right_rocket_launch  ) 

if{  hydra_launch_rocket (  RIGHT  )  ) 

right_rocket_launch  =  FALSE; 

} 

} 

void  mbvec {  str,  vec  ) 
char  *str; 

VECTOR  vec; 

^  printf{  ''%s  [  %1.41f  %1.41f  %1.41f  ]\n“, 
str,  vec[X],  vec[Y],  vec[Z]  ); 

} 


I 
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/*  $Header:  /a3/adst-cm/RWA/AIRNET/simnet/vehicle/libsrc/libmissile/RCS/sub_f lec 

h.c,v  1.4  1993/01/28  23:27:09  cm-adst  Exp  $  */ 

/* 

*  $Log:  sub_flech.c, V  $ 

*  Revision  1.4  1993/01/28  23:27:09  cm-adst 

*  P .DesMeules ' s  changes  for  spcr  31 

*  Revision  1.3  1993/01/06  21:19:27  cm-adst 

*  R. Branson's  changes  for  the  weapons  model. 

*  Revision  1.1  1992/09/30  16:39:52  cm-adst 

*  Initial  Version 

* 

I^atic  Char  RCS  ID[]  =  “$Header:  /a3/adst-cm/RWA/AIRNET/simnet/yehicle/libsrc/li 

£ssne/RCsS-£le=h.c,v  1.4  1993/01/28  23:27,09  cm-adst  Exp  S', 

***************************************** 

n .  . 

★ 


*  RevisiOTis; 

★ 

4 
* 

★ 
it 
it 
★ 

★ 

★ 

★ 

★ 

★ 
it 


Version 

Date 

Author 

1.2  . 

10/23/92 

R.  Branson 

1.3 

10/30/92 

R.  Branson 

1.4  ' 

11/25/92 

R.  Branson 

1.5 

01/19/93 

P .Desmeules 

Title 


SP/CR  Number 


zation 
aded  pathn2 
directory 


fgets  to  make  sure  the 
whole  line  is  read  in. 


31 


************♦****************************************************************/ 

**************************************************************************** 
SP/CR  No.  Description  of  Modification 


/ 


★ 

★ 


Hard  coded  defines  changed  to  array  elements. 
Characteristics /parameter  data  array  added. 

Added  file  reads  for  sub_f lechette  characteristics/ 
parameters  and  f lechette  speed  coefficients. 

Added  " /simnet/data/ "  to  each  data  file  pathname. 

******,***********************************/ 


/ 


★ 


*  FILE:  sub_flech.c 

*  AUTHOR:  Kris  Bartol 

*  MAINTAINER:  Kris  Barto!; 

* 
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*  PURPOSE:  This  file  contains  routines  which  simulates 

*  the  behavior  of  sub-munitions  of  type 

*  munition_US_Flechette_60 . 

*  HISTORY:  10/06/90  kris 

* 

*  Copyright  (c)  1989  BBN  Systems  and  Technologies,  Inc. 

*  All  rights  reserved. 


#include  “stdio.h" 

# include  "math.h" 

# include  " sim_types .h" 

#include  "sim_dfns.h“ 

#include  "basic. h“ 

# include  "mun_type.h" 

#include  “libhull.h" 

#include  “libimps.h" 

# include  "libkin.h" 

Mnclude  "libmath.h" 

# include  “libmap.h" 

# include  " libmatrix.h" 

Sinclude  “ libmiss_dfn .h“ 

#include  " libmiss_loc .h" 

# include  “rkt_hydra .h" 

/* 

*  Debug  macro 
*/ 

tifdef  FILEDBG 
#define  P(a)  a 

ielse 

idefine  P{a) 

#endif 

# define  DEBUG  0  /*  debugging  is  ON  */ 

#define  INVEST_DIST_SQ  sub_f lech_char [ 0 ] 

tdefine  FUZE_DIST_SQ  sub_f lech_char [1] 

#define  FLECHETTE_SPEED_DEG  sub_f lech_poly_deg 

^ ^  Sub_f lechette  characteristic  parameters  initialized  to  default  values 
/*/ 

static  REAL  sub_f lech_char [3 ]  = 

^10000.0,  /*  (100  m)''2  :  :  max  speed  <  100  */ 

306.25,  /*  (17.5  m)^2  ::  flechettes  fly^ 

in  a  cylinder  with  a  radius 
of  17.5  m  and  length  of  750  m  */ 
FLECH_60_MAX_RANGE  /*  darts  fly  total  of  750m  */ 

}; 
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*  The  following  term  sets  the  order  of  the  polynomial  used  to  determine 

*  the  speed  of  the  flechettes. 

/*/ 

static  int  sub_f lech_poly_deg  =  3; 


' *  Coefficients  for  the  speed  polynomial  for  flechettes  initialized 
*  to  default  values. 

/*/ 

static  REAL  f lechette_speed_coef [ 5 ]  = 

^  4]^  75^  /*  a_0  -  m/tick  */ 

-0.20397254,  /*  a_l  -  m/tick/m  *! 

0.00022724278,  /*  a_2  -  m/tick/m-'2  / 

-0.00000008633,  /*  a_3  -  m/tick/m''3  / 

0.0 


static  VECTOR  zero_vector  =  {  0.0,  0.0,  0.0  } ; 
static  VehiclelD  null_VehicleID; 


/*  this  routine  is  invoked  by  the  rva  for  each  vehicle  to  see  if  it 
*  should  be  included  on  the  flechette  valid  vehicle  list 

*/ 

f lechette_is_valid_veh  (veh) 

VehicleAppearanceVariant  *veh; 

^  return(  /*  is_alive_vehicle  (veh->appearance)  */  TRUE  ) ; 

} 


/*******************************************************;;******** 

*  ROUTINE:  missile  f lechette_init 

PARAMETERS:  bmptr  -  Pointer  to  a  _BALLISTIC_MISS  ^ 

structure  that’s  ammo-type  is  Flechette  ^ 
i.e.  it  releases  sub-munitions  of  type 
_munition_US_Flecliette_60_. 
sub_mun  -  Pointer  to  ,sub-n>unition  structure 
associated  with  _bmptr_. 

■  init_speed  -  Terminal  speed  of  rocket  == 
initial  speed  of  flechettes. 

*  ImpTsl-.  ""ialize  rocket’s  _bnptr_  to  behave  according 

*  sub-munitions  type  of  ^ 

*  munition_US_Flechette_60_.  *************/ 

**************************************************  ' 


★ 

* 

★ 

★ 

* 

★ 

★ 

★ 

★ 


void  missile_flechette_init{  bmptr,  si±>_mun,  init_speed 
BALLISTIC_MISSILE  *bmptr; 

BALLISTIC_SUB_MUN  *sub_mun; 
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REAL  init_speed; 

{ 

BALLISTIC_CANISTER  *dart; 

VECTOR  velocity; 

int  i; 

int  data_tmp_int; 
float  data_tmp; 
char  descript [ 80 ] ; 

FILE  *fp; 

P{printf ("$$$$  FLECHETTE  file  data  $$$$\n”);); 

/*  DEFAULT  CHARACTERISTICS  DATA  FOR  sub_flech.c  READ  FROM  FILE  */ 

fp  =  fopen ( “ /simnet/data/sub_f lec .d" , “r" ) ; 
if (fp==NULL) { 

fprintf  {stderr,  "Cannot  open  /simnet/data/sub_f  lec  .d\n'' )  ; 
exit { ) ; 

} 

rewind { fp) ; 

t 

/*  Read  array  data  */ 
i=0; 

while {fscanf (fp, "%f" ,  &data_tmp)  !=  EOF) { 
sub_flech_char [ i]  =  data_tmp; 
fgets (descript,  80,  fp); 

P(printf ("sub_flech_char(%3d)  is%11.3f  %s",  i,  sub_flech_char [i] , 
descript) ; ) ; 

++i; 

} 

f close ( fp) ; 

/*  END  DEFAULT  CHARACTERISTICS  DATA  FOR  sub_flech.c  READ  FROM  FILE  */ 

/*  DEFAULT  FLECHETTE  SPEED  DATA  FOR  sub_flech.c  READ  FROM  FILE  */ 

fp  =  fopen(‘'/simnet/data/flec_spd.d","r"); 
if {fp==NULL) { 

fprintf (stderr,  "Cannot  open  /simnet/data/f lec_spd .d\n“ ) ; 
exitO  ; 

) 

rewind (fp) ; 

/*  Read  degree  of  polynomial  */ 

fscanf  (fp,  "%d'' ,  &data_tmp_int)  ; 

FLECHETTE_SPEED_DEG  =  data_tmp_int ; 
fgets (descript,  80,  fp) ; 

P (printf ( “sub_f lech_poly_deg  is%3d  %s",  FLECHETTE_SPEED_DEG, 
descript) ; ) ; 

/*  Read  array  data  */ 

i  =  0; 
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while { fscanf (fp, "%f",  &data_tmp)  !=  EOF) { 
f lechette_speed_coef [i]  =  data_tmp; 
fgets {descript,  80,  fp); 

P(printf ("flechette_speed_coef (%3d)  is%11.3f  %s”,  i, 

f lechette_speed_coef [ i ] ,  descript) ; ) ; 


fcloss{fp) / 

/*  END  DEFAULT  BURN  SPEED  DATA  FOR  sub_flech.c  READ  FROM  FILE  */ 
bmptr->tinie  =  0; 

dart  =  &  (sub_n\un->dart)  ; 
dart->distance  =  0.0; 
dart->init_speed  =  init_speed; 

dart->pptr  =  NULL;  _  _ 

vec  scale (  bmptr->orientation,  init_speed,  velocity  ); 

missile  util  comm  release_sub_munition (  bmptr,  MSL_TYPE_BALLISTIC, 

missii  _  _  _  sub_mun,  SUB_MUN_CANISTER, 

,  zero_vector,  velocity  ) ; 

^ i f  DEBUG 

printf(  “InitSpeed  %1.21f  Dist  %1.21f\n",  init_speed,  dart->distance  ); 
#endif 
} 


^ ********************************************************* ******* 

*  ROUTINE:  missile_f lechette_f ly  *  ^ 

*  PARAMETERS;  bmptr  -  Pointer  to  a  _BALLISTIC_MISSILE_ 

*  structure  that's  ammo-type  is  Flechette 

*  i.e.  it  releases  sub-munitions  of  type  * 

*  _munition_US_Flechette_60_.  * 

*  sub_mun  -  Pointer  to  sub-munition  structure 

*  associated  with  _bmptr_. 

*  veh_list  -  Vehicle  list  ID. 

*  RETURNS:  none.  _  _  ^ 

*  PURPOSE:  Simulates  the  flying  of  munition-type  ^ 

*  _munition_US_Flechette_60_. 

*  -1200  2"  lead  darts  are  released  and  fly  a  * 

*  cylindrical  pattern  35  m  in  diameter  ...  * 

*  Hence,  we  simulate  the  flechettes  with  ONE  * 

*  dart  flown  down  the  center  of  the  cylinder 

*  and  give  it  a  17.5  m  proximity  fuze.  If  the  * 

*  proximity  fuze  detonates,  we  impact  the 

*  recipient  vehicle  and  continue  the  lone  dart  s 

*  flyout  to  a  distance  of  750  m.  At  this  point,  * 

*  the  flechette  rounds  have  lost  the  momentum  * 

*  and  fall  to  the  ground  --  the  roclcet  is 

*  terminated. 

****************************************************************/ 

int  missile_f lechette_f ly (  bmptr,  sub_mun,  veh_list  ) 
BALLISTIC_MISSILE  *bmptr; 
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BALLISTIC_SUB_MUN  *sub_mun; 
int  veh_list; 

{ 

BALLISTIC_CANISTER  *dart; 
VECTOR  velocity; 


dart  =  & {sub_mun->dart) ; 

/* 

*  SPEED  */ 

bmptr->speed  =  ,  ,  ^ 

missile_util_eval_polY(  FLECHETTE_SPEED_DEG,  f lechette_speed_coef , 

dart->distance  )  +  dart->init_speed; 


/* 

*  DISTANCE  */ 

dart->distance  +=  bmptr->speed; 
if{  dart->distance  >=  sub_f lech_char [2 ]  ) 

return (  FALSE  ) ; 


/* 

*  VELOCITY  */  . 

vec_scale(  bmptr->orientation [Y] ,  bmptr->speed,  velocity  ); 

/* 

<*  POSITION  */ 

vec_add{  bmptr->location,  velocity,  bmptr->location  ); 


/* 

★ 


PROX_FUZE  */'. 
if{  missile_fuze_all_prox 


(  bmptr, 

MSL_TYPE_BALLISTIC ,  PROX_FUZE_ON_ALL_VEH , 
& {null_VehicleID) ,  & (dart->pptr) , 
veh_list,  INVEST_DIST_SQ,  FUZE_DIST_SQ  ) 


) 


/* 


do 


{ 

DETONATION  ?  */ 

if  {  inissile_util_coinm_check_sub_inun  {  bmptr,  MSL_TYPE_BALLISTIC, 

sub_mun,  SUB_MUN_CANISTER  )) 

niissile_util_comm_release_sub_munition (  bmptr, 

MSL_TYPE_BALLISTIC , 


sub_mun, 

SUB_MUN_C ANI STER , 


zero_vector , 
velocity  ) ; 


}  while{  dart->pptr  !=  NULL  && 

inissile_fuze_detonate_prox{  bmptr,  MSL_TYPE_BALLISTIC, 

&(dart->pptr) ,  FUZE_DIST_SQ,  0  )) 

return (  TRUE  ) ; 

} 
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Appendix  P  -  Source  code  listing  for  sub_m73.c. 

The  following  appendix  contains  the  source  code  listing  for 
sub  m73.c  for  convenience  in  document  maintenance  and 
understanding  of  the  CSU. 
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APPENDIX  P  -  sub_m73.c 

/*  $Header:  /a3/adst- 

cm/RWA/AIRNET/simnet/vehicle/libsrc/libmissile/RCS/ sub_m73 .c, v  1.4  1993/01/28 
23:27:09  cm-adst  Exp  $  */ 

/* 

*  $Log:  sub_m73.c,v  $ 

*  Revision  1.4  1993/01/28  23:27:09  cm-adst 

*  P.DesMeules ' s  changes  for  spcr  31 

* 

*  Revision  1.3  1993/01/06  21:19:51  cm-adst 

*  R. Branson's  changes  for  the  weapons  model. 

•k 

*  Revision  1.1  1992/09/30  16:39:52  cm-adst 

*  Initial  Version 


static  char  RCS_ID[]  =  "$Header:  /a3/adst- 

cm/RWA/AIRNET/simnet/vehicle/libsrc/libmissile/RCS/ sub_m73 .c, v  1.4  1993/01/28 
23:27:09  cm-adst  Exp  $"; 


********* 


*,  Revisions : 


Version 


Author  Title 


SP/CR  Number 


*  1.2  10/23/92  R.  Branson  Data  File  Initiali- 

*  zation 

*  1.3  10/30/92  R.  Branson  Added  pathname  to  data 

*  directory 

*  1.5  01/19/93  P.Desmeules  Increased  the  size  of  the  31 

*  fgets  to  make  sure  the 

*  whole  line  is  read  in. 

* 

**************************************•***************************************/ 


SP/CR  No.  Description  of  Modification 


*  Hard  coded  defines  changed  to  array  elements. 

*  Characteristics/parameter  data  array  added. 

*  Added  file  reads  for  sub_m73  characteristics/ 

*  parameters . 

* 

*  Added  " /simnet/data/ "  to  each  data  file  pathname. 

★ 

*****************************************************************************/ 

/**************************************************************** 


*  FILE:  sub_m73.c 

*  AUTHOR:  Kris  Bartol 

*  MAINTAINER:  Kris  Bartol 
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APPENDIX  P  -  sub_m73.c 


*  PURPOSE:  This  file  contains  routines  which  simulates 

*  the  behavior  of  sub-munitions  of  type 

*  munition_US_M73 . 

*  HISTORY:  10/06/90  kris 

* 

*  Copyright  (c)  1989  BBN  Systems  and  Technologies,  Inc. 

*  All  rights  reserved. 


★ 

★ 

★ 

* 

★ 

★ 

★ 

* 

★ 


# include  "stdio.h" 

#include  "math.h" 

#include  " sim_types .h" 

#include  "sim_dfns.h" 

#include  "basic. h" 

#include  ‘'mun_type .h" 

# include  "libmath.h" 

# include  “libmap.h" 

#include  " libmatrix.h" 

# include  “ libmiss_dfn .h“ 

#include  " libmiss_loc .h" 

# include  "rkt_hy<3ra .h" 

/* 

*  Debug  macro 
*/ 

#ifdef  FILEDBG 
#define  P{a)  a 

#else 

#define  P(a) 

#endif 

# define  DEBUG  0  /*  debugging  is  ON  */ 


/*/ 

*  Sub  M73  characteristic  parameters  initialized  to  default  values. 

/*/ 

static  REAL  sub_m73_char [3 ]  = 

0.03266667,  /*  75%  of  gravity  -  75%  *  9 . 8m/sec^''2/225  ticks'''^2*/ 

M73_FOOT_ANGLE_X,  /*  bomblettes  fall  w/  +/-  8.8  deg  angular  disp  ! 

M73_FOOT_ANGLE_Y  /*  bomblettes  fall  w/  +/-  12.35  deg  angular  displ  / 

}; 

static  REAL  zero_velocity [3 ]  =  {  0.0,  0.0,  0.0  }; 


static  void  missile_m73_get_impact  ( ) ; 


/ 


*  ROUTINE:  missile_m73_init 

*  PARAMETERS:  bmptr  -  Pointer  to  a  _BALLISTIC_MISSILE_ 


★ 
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APPENDIX  P  -  sub_m73.c 


★ 

★ 

★ 

★ 

* 

★ 

*  RETURNS: 

*  PURPOSE: 

* 

************** 


structure  that's  ammo-type  is  MPSM 
i.e.  it  releases  sub-munitions  of  type 
_mun i t ion_US_M7  3_ . 

sub_mun  -  Pointer  to  sub-munition  structure 
associated  with  _bmptr_. 
speed  -  Terminal  speed  of  Rocket  at  detonation, 
none 

Initialize  rocket's  _bmptr_  to  behave  according 
sub-munitions  type  of  _munition_US_M73_. 
.*****.***.*************************'********'*'****** 


★ 

★ 

ie 

★ 
* 
•k 
* 
★ 
★  ir 


/ 


void  missile_m73_init (  bmptr,  sub_mun,  speed  ) 
BALLISTIC_MISSILE  *bmptr; 

BALLISTIC_SUB_MUN  *sub_mun; 

REAL  speed; 

{ 

VECTOR  impact_pt; 

VECTOR  displacement; 


int  i  ; 
float  data_tmp; 

<  char  descript [80] ; 

FILE  *fp; 


P (printf ( " $$$$  M73  file  data  $$$$\n");); 

/*  DEFAULT  CHARACTERISTICS  DATA  FOR  sub_m73.c  READ  FROM  FILE  */ 

fp  =  fopen(“/simnet/data/sub_m73.d'',  "r")  ; 
if {fp==NULL) { 

fprintf (stderr,  "Cannot  open  /simnet/data/sub_m73 .d\n  ); 
exit { ) ; 

} 

rewind (fp) ; 

/*  Read  array  data  */ 
i  =  0; 

while { fscanf  (fp, ''%f" ,  &data_tmp)  !=  EOF)  { 
sub_m7  3_char [ i ]  =  data_tmp ; 

fgets (descript,  80,  fp) ;  ,  r-n 

P (printf  (“ sub_m73_char {%3d)  is%11.3f  %s'',  i,  sub_m73_char  [ i]  , 

descript) ; ) ; 

++i; 

} 


fclose ( fp) ;  ^ 

/*  END  DEFAULT  CHARACTERISTICS  DATA  FOR  sub_m73.c  READ  FROM  FILE  / 


bmptr->time  =  0; 

sub_mun->impact .  timer  =  0;  , ,  j  i 

sub  mun->impact .distance  =  speed;  /*  distance  rocket  travelled  last 

frame,  i.e.  before  detonation  */ 

/* 
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get  point  under  sub-munition  release  point 

/ 

impact_pt[X]  =  bmptr->location [X] ; 
impact_pt[Y]  =  bmptr->location [Y]  -  10; 
impact_pt[Z]  =  10.0; 

missile_util_comm_release_sub_munition(  bmptr,  MSL_TYPE_BALLISTIC, 

sub_mun ,  SUB_MUN_IMPACT , 
impact_pt,  zero_velocity  ); 


^ **************************************************************** 

*  ROUTINE:  missile_m73_drop  * 

*  PARAMETERS:  bmptr  -  Pointer  to  a  _BALLISTIC_MISSILE_  * 

*  structure  that’s  ammo-type  is  MPSM  * 

*  i.e.  it  releases  sub-munitions  of  type  * 

*  _munition_US_M73_.  * 

*  sub_mun  -  Pointer  to  sub-munition  structure  * 

*  associated  with  _bmptr_.  * 

*  RETURNS:  TRUE  if  time  of  drop  has  been  long  enough  to  * 

*  cause  sub-munitions  to  hit  the  ground.  * 

,*  FALSE  otherwise.  * 

*  PURPOSE:  Simulation  of  the  dropping  of  munition-type  * 

*  ‘_munition_US_M73_  rounds.  * 

****************************************************************/ 

( 

static  int  traj_up  =  TRUE;  /*  TRUE:  vector  UP  --  FALSE:  vector  down  */ 

int  missile_m73_drop(  bmptr,  sub_mun  ) 

BALLISTIC_MISSILE  *bmptr; 

BALLISTIC_SUB_MUN  *sub_mun; 

{ 

BALLISTIC_IMPACT  *impact; 

VECTOR  impact_pt; 

impact  =  & (sub_mun->impact) ; 
if{  impact->timer  ==  0  ) 

if(  missile_util_comm_check_sub_mun (  bmptr,  MSL_TYPE_BALLISTIC, 

sub_mun ,  SUB_MUN_IMPACT  ) ) 

{ 

if{  impact->distance  >0.0  ) 
impact->timer  =  (int) 

{(8  *  scaled_rand { ) )  +1.0+ 

(sqrt((1.9  *  impact ->distance)  /  sub_m73_char [ 0 ] ) ) ) 

else 

impact->timer  =  -1; 


#if  DEBUG 


tfendif 


printf(  "Height  %1.41f  Time  %d\n'', 

impact->distance,  impact->timer ) ; 


impact_pt[X]  =  bmptr->location [X] ; 
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iinpact_pt  [Y]  =  bmptr->location  [Y]  -  10; 
if{  traj_up  ) 

impact_pt[Z]  =  bmptr->location[Z]  +  impact->distance; 

else 

impact_pt[Z]  =  10; 
traj_up  =  (  !  traj_up  ) ; 

missile_util_comm_release_sub_munition {  bmptr ,  MSL_TYPE_BALLISTIC, 

sub_mun,  SUB_MUN_IMPACT , 
impact_pt,  zero_velocity  ); 


} 


/*  wait  until  sub_mun's  */ 
/*  hit  the  ground....  */ 
/*  incr  time  counter  */ 


/’ 


le . 


return (  FALSE  ) ; 

} 

else 

{ 

if(  bmptr->time  <  impact->timer  ) 

{ 

bmptr->time  +=  1; 
return (  FALSE  ) ; 

} 

else 

{ 

I  if{  impact->timer  >  0  ) 

{ 

missile_m73_get_impact {  bmptr->location,  impact_pt 

bmptr->launcher_C_world, 
impact->distance  ) ; 

m i s  s i 1 e_u  t i l_c omm_r e 1 eas  e_s ub_mun i t i on 

{  bmptr,  MSL_TYPE_BALLISTIC,  sub_mun, 
SUB_MUN_IMPACT,  impact_pt,  zero_velocity  ) ; 

) 

/*  reset  time  counter  */ 

bmptr->time  =  0; 
return (  TRUE  ) ; 

} 

} 

} 


time  ==  timer  */ 


/**************************************************************** 

*  ROUTINE:  missile_m73_impact  * 

*  PARAMETERS:  bmptr  -  Pointer  to  a  _BALLISTIC_MISSILE_  ^ 

*  structure  that's  ammo-type  is  MPSM  * 

*  i.e.  it  releases  sub-munitions  of  type  * 

*  _munition_US_M73_.  * 

*  sub_mun  -  Pointer  to  sub-munition  structure  * 

*  associated  with  _bmptr_.  * 

*  RETURNS:  FALSE  if  all  m73  have  impacted  the  ground.  * 

*  PURPOSE:  Simulation  of  _munition_US_M73_  impacts.  * 

****************************************************************/ 


int  missile_m73_impact {  bmptr,  sub_raun  ) 
BALLISTIC_MISSILE  *bmptr,- 
BALLISTIC_SUB_MUN  *sub_mun; 

{ 

BALLISTIC_IMPACT  ‘impact; 
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VECTOR 


impact_pt; 


impact  =  & (sub_mun->impact) ; 
if (  impact->timer  <  0  ) 

( 

#if  DEBUG 

printf(  "ignore  under  ground  detonation\n" ,  bmptr->missile_id  ); 

#endif 

return {  FALSE  )  ; 

} 

if(  bmptr->time  <  1  ) 
impact->delay  =  0; 

else  /*  0  -  0.250  sec  delay  */ 

impact->delay  =  {int)(250  *  scaled_rand { ) ) ; 


bmptr->time  +=  1; 

if(  missile_util_comm_check_sub_mun (  bmptr,  MSL_TYPE_BALLISTIC, 

sub_mun,  SUB_MUN_IMPACT  )) 


{ 

/* 

*  send  _impact_  to  util_ball  &  to  world 

»*  missile_util_comm_impact_ball_sub_munition {  bmptr,  impact  ) ; 

*/ 

impact->quantity  -=  1; 

/* 

*  get  NEXT  M73  _impact_location_  OR  stop 
*/ 

if(  impact ->quantity  >  0  ) 

{ 

missile_m73_get_impact {  bmptr->location,  impact_pt, 

bmptr->launcher_C_world, 
impact->distance  ) ; 

missile_util_comm_release_sub_munition (  bmptr ,  MSL_TYPE_BALLISTIC, 

sub_mun,  SUB_MUN_IMPACT , 
impact_pt,  zero_velocity  ) ; 

return {  TRUE  ) ; 

) 

else 

return {  FALSE  ) ; 

} 

else  /*  Didn't  get  an  impact  */ 

{ 

missile_m73_get_impact (  bmptr->location,  impact_pt, 

bmptr->launcher_C_world, 
impact->distance  ) ; 

missile_util_comm_release_sub_munition {  bmptr,  MSL_TYPE_BALLISTIC, 

sub_mun ,  SUB_MUN_IMPACT , 
impact_pt,  zero_velocity  ) ; 
if{  bmptr->time  >  impact->timer  )  /*  time's  up  */ 

{ 

printf{  "M73_SIMUL  timed-out:  %d  non-impacts\n" , 
impact->quantity  ) ; 
return {  FALSE  ) ; 

) 

return (  TRUE  ) ;  /*  keep  trying  */ 
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static  void  inissile_m73_get_impact 
VECTOR  release_pt; 

VECTOR  impact_pt; 

T_MAT_PTR  mCw; 

REAL  height; 

VECTOR  detonation;  / 


release_pt,  iinpact_pt,  mCw,  height 


Offset  Vector  in  World  Coords 
of  detonation  point  */ 


) 


REAL  X,  y; 


X  =  height  *  sin  (deg_to_rad {  sub_in73_char [1] 

V  =  height  *  sin (deg_to_rad (  sub_m73_char [2] 
detonation [X]  =  x  *  mCw[0]  [0]  -  y  *  inCw[0]  [l]  ; 
detonation[Y]  =  y  *  mCw[0] [0]  +  x  *  mCw[0] [1] ; 
detonation [ Z ]  =  -  height; 


{0.50 

(0.50 


scaled_rand () ) ) ) 
scaled_rand() ) ) ) 


Stretch  .detonation,  vector  to  ensure  intersection  with  ground/vehicle 
Yec_sc3.l6  {  dstoncLtioH/  1.5,  d,eton3.tion  )  ; 

' *  add  to  .release_pt.  to  get  location  of  .impact,  in  World  Coords 


*/ 

vec.add (  release.pt,  detonation, 

} 


impact.pt  ) ; 
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